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> 321da177e4SLinus Torvalds #include <net/arp.h> 331da177e4SLinus Torvalds 341da177e4SLinus Torvalds #include "vlan.h" 351da177e4SLinus Torvalds #include "vlanproc.h" 361da177e4SLinus Torvalds #include <linux/if_vlan.h> 376d4cdf47SBenjamin LaHaise #include <linux/netpoll.h> 381da177e4SLinus Torvalds 391da177e4SLinus Torvalds /* 401da177e4SLinus Torvalds * Create the VLAN header for an arbitrary protocol layer 411da177e4SLinus Torvalds * 421da177e4SLinus Torvalds * saddr=NULL means use device source address 431da177e4SLinus Torvalds * daddr=NULL means leave destination address (eg unresolved arp) 441da177e4SLinus Torvalds * 451da177e4SLinus Torvalds * This is called when the SKB is moving down the stack towards the 461da177e4SLinus Torvalds * physical devices. 471da177e4SLinus Torvalds */ 48ef3eb3e5SPatrick McHardy static int vlan_dev_hard_header(struct sk_buff *skb, struct net_device *dev, 493b04dddeSStephen Hemminger unsigned short type, 50ef3eb3e5SPatrick McHardy const void *daddr, const void *saddr, 51ef3eb3e5SPatrick McHardy unsigned int len) 521da177e4SLinus Torvalds { 531fd9b1fcSPatrick McHardy struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 541da177e4SLinus Torvalds struct vlan_hdr *vhdr; 551349fe9aSPatrick McHardy unsigned int vhdrlen = 0; 569bb8582eSPatrick McHardy u16 vlan_tci = 0; 571349fe9aSPatrick McHardy int rc; 581da177e4SLinus Torvalds 590c0667a8SWang Sheng-Hui if (!(vlan->flags & VLAN_FLAG_REORDER_HDR)) { 601da177e4SLinus Torvalds vhdr = (struct vlan_hdr *) skb_push(skb, VLAN_HLEN); 611da177e4SLinus Torvalds 620c0667a8SWang Sheng-Hui vlan_tci = vlan->vlan_id; 63e267cb96SDavid S. Miller vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority); 649bb8582eSPatrick McHardy vhdr->h_vlan_TCI = htons(vlan_tci); 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds /* 67bf9ae538SOctavian Purdila * Set the protocol type. For a packet of type ETH_P_802_3/2 we 68bf9ae538SOctavian Purdila * put the length in here instead. 691da177e4SLinus Torvalds */ 70bf9ae538SOctavian Purdila if (type != ETH_P_802_3 && type != ETH_P_802_2) 711da177e4SLinus Torvalds vhdr->h_vlan_encapsulated_proto = htons(type); 722029cc2cSPatrick McHardy else 731da177e4SLinus Torvalds vhdr->h_vlan_encapsulated_proto = htons(len); 74279e172aSJerome Borsboom 751fd9b1fcSPatrick McHardy skb->protocol = vlan->vlan_proto; 761fd9b1fcSPatrick McHardy type = ntohs(vlan->vlan_proto); 771349fe9aSPatrick McHardy vhdrlen = VLAN_HLEN; 781da177e4SLinus Torvalds } 791da177e4SLinus Torvalds 801da177e4SLinus Torvalds /* Before delegating work to the lower layer, enter our MAC-address */ 811da177e4SLinus Torvalds if (saddr == NULL) 821da177e4SLinus Torvalds saddr = dev->dev_addr; 831da177e4SLinus Torvalds 841da177e4SLinus Torvalds /* Now make the underlying real hard header */ 850c0667a8SWang Sheng-Hui dev = vlan->real_dev; 861349fe9aSPatrick McHardy rc = dev_hard_header(skb, dev, type, daddr, saddr, len + vhdrlen); 870c4e8581SStephen Hemminger if (rc > 0) 881349fe9aSPatrick McHardy rc += vhdrlen; 891da177e4SLinus Torvalds return rc; 901da177e4SLinus Torvalds } 911da177e4SLinus Torvalds 926eacf8adSAmerigo Wang static inline netdev_tx_t vlan_netpoll_send_skb(struct vlan_dev_priv *vlan, struct sk_buff *skb) 936eacf8adSAmerigo Wang { 946eacf8adSAmerigo Wang #ifdef CONFIG_NET_POLL_CONTROLLER 956eacf8adSAmerigo Wang if (vlan->netpoll) 966eacf8adSAmerigo Wang netpoll_send_skb(vlan->netpoll, skb); 976eacf8adSAmerigo Wang #else 986eacf8adSAmerigo Wang BUG(); 996eacf8adSAmerigo Wang #endif 1006eacf8adSAmerigo Wang return NETDEV_TX_OK; 1016eacf8adSAmerigo Wang } 1026eacf8adSAmerigo Wang 1036fef4c0cSStephen Hemminger static netdev_tx_t vlan_dev_hard_start_xmit(struct sk_buff *skb, 1046fef4c0cSStephen Hemminger struct net_device *dev) 1051da177e4SLinus Torvalds { 1066eacf8adSAmerigo Wang struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 1071da177e4SLinus Torvalds struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data); 1081a123a31SEric Dumazet unsigned int len; 1091a123a31SEric Dumazet int ret; 11055b01e86SDavid S. Miller 1111da177e4SLinus Torvalds /* Handle non-VLAN frames if they are sent to us, for example by DHCP. 1121da177e4SLinus Torvalds * 1131da177e4SLinus Torvalds * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING 1141da177e4SLinus Torvalds * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs... 1151da177e4SLinus Torvalds */ 1161fd9b1fcSPatrick McHardy if (veth->h_vlan_proto != vlan->vlan_proto || 1176eacf8adSAmerigo Wang vlan->flags & VLAN_FLAG_REORDER_HDR) { 1189bb8582eSPatrick McHardy u16 vlan_tci; 1196eacf8adSAmerigo Wang vlan_tci = vlan->vlan_id; 120e267cb96SDavid S. Miller vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority); 121b960a0acSJiri Pirko __vlan_hwaccel_put_tag(skb, vlan->vlan_proto, vlan_tci); 122636e19a3SJohn Fastabend } 1231da177e4SLinus Torvalds 1246eacf8adSAmerigo Wang skb->dev = vlan->real_dev; 1251a123a31SEric Dumazet len = skb->len; 1266eacf8adSAmerigo Wang if (unlikely(netpoll_tx_running(dev))) 1276eacf8adSAmerigo Wang return vlan_netpoll_send_skb(vlan, skb); 1286eacf8adSAmerigo Wang 1291a123a31SEric Dumazet ret = dev_queue_xmit(skb); 1301a123a31SEric Dumazet 1312d6c9ffcSEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 1324af429d2SEric Dumazet struct vlan_pcpu_stats *stats; 1334af429d2SEric Dumazet 1346eacf8adSAmerigo Wang stats = this_cpu_ptr(vlan->vlan_pcpu_stats); 1354af429d2SEric Dumazet u64_stats_update_begin(&stats->syncp); 1364af429d2SEric Dumazet stats->tx_packets++; 1374af429d2SEric Dumazet stats->tx_bytes += len; 138307f73dfSWei Yongjun u64_stats_update_end(&stats->syncp); 1394af429d2SEric Dumazet } else { 1406eacf8adSAmerigo Wang this_cpu_inc(vlan->vlan_pcpu_stats->tx_dropped); 1414af429d2SEric Dumazet } 1421a123a31SEric Dumazet 143cbbef5e1SPatrick McHardy return ret; 1441da177e4SLinus Torvalds } 1451da177e4SLinus Torvalds 146ef3eb3e5SPatrick McHardy static int vlan_dev_change_mtu(struct net_device *dev, int new_mtu) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds /* TODO: gotta make sure the underlying layer can handle it, 1491da177e4SLinus Torvalds * maybe an IFF_VLAN_CAPABLE flag for devices? 1501da177e4SLinus Torvalds */ 1517da82c06SJiri Pirko if (vlan_dev_priv(dev)->real_dev->mtu < new_mtu) 1521da177e4SLinus Torvalds return -ERANGE; 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds dev->mtu = new_mtu; 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds return 0; 1571da177e4SLinus Torvalds } 1581da177e4SLinus Torvalds 159c17d8874SPatrick McHardy void vlan_dev_set_ingress_priority(const struct net_device *dev, 1609bb8582eSPatrick McHardy u32 skb_prio, u16 vlan_prio) 1611da177e4SLinus Torvalds { 1627da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 163b020cb48SPatrick McHardy 164b020cb48SPatrick McHardy if (vlan->ingress_priority_map[vlan_prio & 0x7] && !skb_prio) 165b020cb48SPatrick McHardy vlan->nr_ingress_mappings--; 166b020cb48SPatrick McHardy else if (!vlan->ingress_priority_map[vlan_prio & 0x7] && skb_prio) 167b020cb48SPatrick McHardy vlan->nr_ingress_mappings++; 168b020cb48SPatrick McHardy 169b020cb48SPatrick McHardy vlan->ingress_priority_map[vlan_prio & 0x7] = skb_prio; 1701da177e4SLinus Torvalds } 1711da177e4SLinus Torvalds 172c17d8874SPatrick McHardy int vlan_dev_set_egress_priority(const struct net_device *dev, 1739bb8582eSPatrick McHardy u32 skb_prio, u16 vlan_prio) 1741da177e4SLinus Torvalds { 1757da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 1761da177e4SLinus Torvalds struct vlan_priority_tci_mapping *mp = NULL; 1771da177e4SLinus Torvalds struct vlan_priority_tci_mapping *np; 17805423b24SEric Dumazet u32 vlan_qos = (vlan_prio << VLAN_PRIO_SHIFT) & VLAN_PRIO_MASK; 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds /* See if a priority mapping exists.. */ 181b020cb48SPatrick McHardy mp = vlan->egress_priority_map[skb_prio & 0xF]; 1821da177e4SLinus Torvalds while (mp) { 1831da177e4SLinus Torvalds if (mp->priority == skb_prio) { 184b020cb48SPatrick McHardy if (mp->vlan_qos && !vlan_qos) 185b020cb48SPatrick McHardy vlan->nr_egress_mappings--; 186b020cb48SPatrick McHardy else if (!mp->vlan_qos && vlan_qos) 187b020cb48SPatrick McHardy vlan->nr_egress_mappings++; 188b020cb48SPatrick McHardy mp->vlan_qos = vlan_qos; 1891da177e4SLinus Torvalds return 0; 1901da177e4SLinus Torvalds } 1911da177e4SLinus Torvalds mp = mp->next; 1921da177e4SLinus Torvalds } 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds /* Create a new mapping then. */ 195b020cb48SPatrick McHardy mp = vlan->egress_priority_map[skb_prio & 0xF]; 1961da177e4SLinus Torvalds np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL); 197c17d8874SPatrick McHardy if (!np) 198c17d8874SPatrick McHardy return -ENOBUFS; 199c17d8874SPatrick McHardy 2001da177e4SLinus Torvalds np->next = mp; 2011da177e4SLinus Torvalds np->priority = skb_prio; 202b020cb48SPatrick McHardy np->vlan_qos = vlan_qos; 2033e3aac49SEric Dumazet /* Before inserting this element in hash table, make sure all its fields 2043e3aac49SEric Dumazet * are committed to memory. 205e267cb96SDavid S. Miller * coupled with smp_rmb() in vlan_dev_get_egress_qos_mask() 2063e3aac49SEric Dumazet */ 2073e3aac49SEric Dumazet smp_wmb(); 208b020cb48SPatrick McHardy vlan->egress_priority_map[skb_prio & 0xF] = np; 209b020cb48SPatrick McHardy if (vlan_qos) 210b020cb48SPatrick McHardy vlan->nr_egress_mappings++; 2111da177e4SLinus Torvalds return 0; 2121da177e4SLinus Torvalds } 2131da177e4SLinus Torvalds 214a4bf3af4SPatrick McHardy /* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */ 215b3ce0325SPatrick McHardy int vlan_dev_change_flags(const struct net_device *dev, u32 flags, u32 mask) 2161da177e4SLinus Torvalds { 2177da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 218b3ce0325SPatrick McHardy u32 old_flags = vlan->flags; 219b3ce0325SPatrick McHardy 2205e756593SPatrick McHardy if (mask & ~(VLAN_FLAG_REORDER_HDR | VLAN_FLAG_GVRP | 22186fbe9bbSDavid Ward VLAN_FLAG_LOOSE_BINDING | VLAN_FLAG_MVRP)) 2221da177e4SLinus Torvalds return -EINVAL; 223b3ce0325SPatrick McHardy 224b3ce0325SPatrick McHardy vlan->flags = (old_flags & ~mask) | (flags & mask); 22570c03b49SPatrick McHardy 22670c03b49SPatrick McHardy if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_GVRP) { 22770c03b49SPatrick McHardy if (vlan->flags & VLAN_FLAG_GVRP) 22870c03b49SPatrick McHardy vlan_gvrp_request_join(dev); 22970c03b49SPatrick McHardy else 23070c03b49SPatrick McHardy vlan_gvrp_request_leave(dev); 23170c03b49SPatrick McHardy } 23286fbe9bbSDavid Ward 23386fbe9bbSDavid Ward if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_MVRP) { 23486fbe9bbSDavid Ward if (vlan->flags & VLAN_FLAG_MVRP) 23586fbe9bbSDavid Ward vlan_mvrp_request_join(dev); 23686fbe9bbSDavid Ward else 23786fbe9bbSDavid Ward vlan_mvrp_request_leave(dev); 23886fbe9bbSDavid Ward } 239b3ce0325SPatrick McHardy return 0; 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds 242c17d8874SPatrick McHardy void vlan_dev_get_realdev_name(const struct net_device *dev, char *result) 2431da177e4SLinus Torvalds { 2447da82c06SJiri Pirko strncpy(result, vlan_dev_priv(dev)->real_dev->name, 23); 2451da177e4SLinus Torvalds } 2461da177e4SLinus Torvalds 247ef3eb3e5SPatrick McHardy static int vlan_dev_open(struct net_device *dev) 2481da177e4SLinus Torvalds { 2497da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 2508c979c26SPatrick McHardy struct net_device *real_dev = vlan->real_dev; 2518c979c26SPatrick McHardy int err; 2528c979c26SPatrick McHardy 2535e756593SPatrick McHardy if (!(real_dev->flags & IFF_UP) && 2545e756593SPatrick McHardy !(vlan->flags & VLAN_FLAG_LOOSE_BINDING)) 2551da177e4SLinus Torvalds return -ENETDOWN; 2561da177e4SLinus Torvalds 25753a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) { 258a748ee24SJiri Pirko err = dev_uc_add(real_dev, dev->dev_addr); 2598c979c26SPatrick McHardy if (err < 0) 26089146504SWang Chen goto out; 2618c979c26SPatrick McHardy } 2628c979c26SPatrick McHardy 26389146504SWang Chen if (dev->flags & IFF_ALLMULTI) { 26489146504SWang Chen err = dev_set_allmulti(real_dev, 1); 26589146504SWang Chen if (err < 0) 26689146504SWang Chen goto del_unicast; 26789146504SWang Chen } 26889146504SWang Chen if (dev->flags & IFF_PROMISC) { 26989146504SWang Chen err = dev_set_promiscuity(real_dev, 1); 27089146504SWang Chen if (err < 0) 27189146504SWang Chen goto clear_allmulti; 27289146504SWang Chen } 27389146504SWang Chen 27407fc67beSJoe Perches ether_addr_copy(vlan->real_dev_addr, real_dev->dev_addr); 2756c78dcbdSPatrick McHardy 27670c03b49SPatrick McHardy if (vlan->flags & VLAN_FLAG_GVRP) 27770c03b49SPatrick McHardy vlan_gvrp_request_join(dev); 27870c03b49SPatrick McHardy 27986fbe9bbSDavid Ward if (vlan->flags & VLAN_FLAG_MVRP) 28086fbe9bbSDavid Ward vlan_mvrp_request_join(dev); 28186fbe9bbSDavid Ward 2820ac820eeSPhil Oester if (netif_carrier_ok(real_dev)) 283adc667e8SJay Vosburgh netif_carrier_on(dev); 2841da177e4SLinus Torvalds return 0; 28589146504SWang Chen 28689146504SWang Chen clear_allmulti: 28789146504SWang Chen if (dev->flags & IFF_ALLMULTI) 28889146504SWang Chen dev_set_allmulti(real_dev, -1); 28989146504SWang Chen del_unicast: 29053a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 291a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 29289146504SWang Chen out: 293adc667e8SJay Vosburgh netif_carrier_off(dev); 29489146504SWang Chen return err; 2951da177e4SLinus Torvalds } 2961da177e4SLinus Torvalds 297ef3eb3e5SPatrick McHardy static int vlan_dev_stop(struct net_device *dev) 2981da177e4SLinus Torvalds { 2997da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 30070c03b49SPatrick McHardy struct net_device *real_dev = vlan->real_dev; 30170c03b49SPatrick McHardy 30256addd6eSPatrick McHardy dev_mc_unsync(real_dev, dev); 303a748ee24SJiri Pirko dev_uc_unsync(real_dev, dev); 3046c78dcbdSPatrick McHardy if (dev->flags & IFF_ALLMULTI) 3056c78dcbdSPatrick McHardy dev_set_allmulti(real_dev, -1); 3066c78dcbdSPatrick McHardy if (dev->flags & IFF_PROMISC) 3076c78dcbdSPatrick McHardy dev_set_promiscuity(real_dev, -1); 3086c78dcbdSPatrick McHardy 30953a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 310a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 3118c979c26SPatrick McHardy 312adc667e8SJay Vosburgh netif_carrier_off(dev); 3131da177e4SLinus Torvalds return 0; 3141da177e4SLinus Torvalds } 3151da177e4SLinus Torvalds 316ef3eb3e5SPatrick McHardy static int vlan_dev_set_mac_address(struct net_device *dev, void *p) 31739aaac11SPatrick McHardy { 3187da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 31939aaac11SPatrick McHardy struct sockaddr *addr = p; 32039aaac11SPatrick McHardy int err; 32139aaac11SPatrick McHardy 32239aaac11SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 32339aaac11SPatrick McHardy return -EADDRNOTAVAIL; 32439aaac11SPatrick McHardy 32539aaac11SPatrick McHardy if (!(dev->flags & IFF_UP)) 32639aaac11SPatrick McHardy goto out; 32739aaac11SPatrick McHardy 32853a2b3a1SJoe Perches if (!ether_addr_equal(addr->sa_data, real_dev->dev_addr)) { 329a748ee24SJiri Pirko err = dev_uc_add(real_dev, addr->sa_data); 33039aaac11SPatrick McHardy if (err < 0) 33139aaac11SPatrick McHardy return err; 33239aaac11SPatrick McHardy } 33339aaac11SPatrick McHardy 33453a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 335a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 33639aaac11SPatrick McHardy 33739aaac11SPatrick McHardy out: 33807fc67beSJoe Perches ether_addr_copy(dev->dev_addr, addr->sa_data); 33939aaac11SPatrick McHardy return 0; 34039aaac11SPatrick McHardy } 34139aaac11SPatrick McHardy 342ef3eb3e5SPatrick McHardy static int vlan_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) 3431da177e4SLinus Torvalds { 3447da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 345656299f7SStephen Hemminger const struct net_device_ops *ops = real_dev->netdev_ops; 3461da177e4SLinus Torvalds struct ifreq ifrr; 3471da177e4SLinus Torvalds int err = -EOPNOTSUPP; 3481da177e4SLinus Torvalds 3491da177e4SLinus Torvalds strncpy(ifrr.ifr_name, real_dev->name, IFNAMSIZ); 3501da177e4SLinus Torvalds ifrr.ifr_ifru = ifr->ifr_ifru; 3511da177e4SLinus Torvalds 3521da177e4SLinus Torvalds switch (cmd) { 3531da177e4SLinus Torvalds case SIOCGMIIPHY: 3541da177e4SLinus Torvalds case SIOCGMIIREG: 3551da177e4SLinus Torvalds case SIOCSMIIREG: 356a6111d3cSStefan Sørensen case SIOCSHWTSTAMP: 357a6111d3cSStefan Sørensen case SIOCGHWTSTAMP: 358656299f7SStephen Hemminger if (netif_device_present(real_dev) && ops->ndo_do_ioctl) 359656299f7SStephen Hemminger err = ops->ndo_do_ioctl(real_dev, &ifrr, cmd); 3601da177e4SLinus Torvalds break; 3611da177e4SLinus Torvalds } 3621da177e4SLinus Torvalds 3631da177e4SLinus Torvalds if (!err) 3641da177e4SLinus Torvalds ifr->ifr_ifru = ifrr.ifr_ifru; 3651da177e4SLinus Torvalds 3661da177e4SLinus Torvalds return err; 3671da177e4SLinus Torvalds } 3681da177e4SLinus Torvalds 369cc883d16SFrank Blaschka static int vlan_dev_neigh_setup(struct net_device *dev, struct neigh_parms *pa) 370cc883d16SFrank Blaschka { 3717da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 372cc883d16SFrank Blaschka const struct net_device_ops *ops = real_dev->netdev_ops; 373cc883d16SFrank Blaschka int err = 0; 374cc883d16SFrank Blaschka 375cc883d16SFrank Blaschka if (netif_device_present(real_dev) && ops->ndo_neigh_setup) 3769d40bbdaSDavid S. Miller err = ops->ndo_neigh_setup(real_dev, pa); 377cc883d16SFrank Blaschka 378cc883d16SFrank Blaschka return err; 379cc883d16SFrank Blaschka } 380cc883d16SFrank Blaschka 381f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 382b85daa53SVasu Dev static int vlan_dev_fcoe_ddp_setup(struct net_device *dev, u16 xid, 383b85daa53SVasu Dev struct scatterlist *sgl, unsigned int sgc) 384b85daa53SVasu Dev { 3857da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 386b85daa53SVasu Dev const struct net_device_ops *ops = real_dev->netdev_ops; 387b85daa53SVasu Dev int rc = 0; 388b85daa53SVasu Dev 389b85daa53SVasu Dev if (ops->ndo_fcoe_ddp_setup) 390b85daa53SVasu Dev rc = ops->ndo_fcoe_ddp_setup(real_dev, xid, sgl, sgc); 391b85daa53SVasu Dev 392b85daa53SVasu Dev return rc; 393b85daa53SVasu Dev } 394b85daa53SVasu Dev 395b85daa53SVasu Dev static int vlan_dev_fcoe_ddp_done(struct net_device *dev, u16 xid) 396b85daa53SVasu Dev { 3977da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 398b85daa53SVasu Dev const struct net_device_ops *ops = real_dev->netdev_ops; 399b85daa53SVasu Dev int len = 0; 400b85daa53SVasu Dev 401b85daa53SVasu Dev if (ops->ndo_fcoe_ddp_done) 402b85daa53SVasu Dev len = ops->ndo_fcoe_ddp_done(real_dev, xid); 403b85daa53SVasu Dev 404b85daa53SVasu Dev return len; 405b85daa53SVasu Dev } 4060af46d99SYi Zou 4070af46d99SYi Zou static int vlan_dev_fcoe_enable(struct net_device *dev) 4080af46d99SYi Zou { 4097da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4100af46d99SYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4110af46d99SYi Zou int rc = -EINVAL; 4120af46d99SYi Zou 4130af46d99SYi Zou if (ops->ndo_fcoe_enable) 4140af46d99SYi Zou rc = ops->ndo_fcoe_enable(real_dev); 4150af46d99SYi Zou return rc; 4160af46d99SYi Zou } 4170af46d99SYi Zou 4180af46d99SYi Zou static int vlan_dev_fcoe_disable(struct net_device *dev) 4190af46d99SYi Zou { 4207da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4210af46d99SYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4220af46d99SYi Zou int rc = -EINVAL; 4230af46d99SYi Zou 4240af46d99SYi Zou if (ops->ndo_fcoe_disable) 4250af46d99SYi Zou rc = ops->ndo_fcoe_disable(real_dev); 4260af46d99SYi Zou return rc; 4270af46d99SYi Zou } 428d6534799SYi Zou 429d6534799SYi Zou static int vlan_dev_fcoe_get_wwn(struct net_device *dev, u64 *wwn, int type) 430d6534799SYi Zou { 4317da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 432d6534799SYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 433d6534799SYi Zou int rc = -EINVAL; 434d6534799SYi Zou 435d6534799SYi Zou if (ops->ndo_fcoe_get_wwn) 436d6534799SYi Zou rc = ops->ndo_fcoe_get_wwn(real_dev, wwn, type); 437d6534799SYi Zou return rc; 438d6534799SYi Zou } 4394ea09c9cSYi Zou 4404ea09c9cSYi Zou static int vlan_dev_fcoe_ddp_target(struct net_device *dev, u16 xid, 4414ea09c9cSYi Zou struct scatterlist *sgl, unsigned int sgc) 4424ea09c9cSYi Zou { 4437da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4444ea09c9cSYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4454ea09c9cSYi Zou int rc = 0; 4464ea09c9cSYi Zou 4474ea09c9cSYi Zou if (ops->ndo_fcoe_ddp_target) 4484ea09c9cSYi Zou rc = ops->ndo_fcoe_ddp_target(real_dev, xid, sgl, sgc); 4494ea09c9cSYi Zou 4504ea09c9cSYi Zou return rc; 4514ea09c9cSYi Zou } 452b85daa53SVasu Dev #endif 453b85daa53SVasu Dev 454ef3eb3e5SPatrick McHardy static void vlan_dev_change_rx_flags(struct net_device *dev, int change) 4556c78dcbdSPatrick McHardy { 4567da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4576c78dcbdSPatrick McHardy 458deede2faSMatthijs Kooijman if (dev->flags & IFF_UP) { 4596c78dcbdSPatrick McHardy if (change & IFF_ALLMULTI) 4606c78dcbdSPatrick McHardy dev_set_allmulti(real_dev, dev->flags & IFF_ALLMULTI ? 1 : -1); 4616c78dcbdSPatrick McHardy if (change & IFF_PROMISC) 4626c78dcbdSPatrick McHardy dev_set_promiscuity(real_dev, dev->flags & IFF_PROMISC ? 1 : -1); 4636c78dcbdSPatrick McHardy } 464deede2faSMatthijs Kooijman } 4656c78dcbdSPatrick McHardy 466e83a2ea8SChris Leech static void vlan_dev_set_rx_mode(struct net_device *vlan_dev) 4671da177e4SLinus Torvalds { 468d38569abSVlad Yasevich dev_mc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev); 469d38569abSVlad Yasevich dev_uc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev); 4701da177e4SLinus Torvalds } 471ef3eb3e5SPatrick McHardy 472ef3eb3e5SPatrick McHardy /* 473ef3eb3e5SPatrick McHardy * vlan network devices have devices nesting below it, and are a special 474ef3eb3e5SPatrick McHardy * "super class" of normal network devices; split their locks off into a 475ef3eb3e5SPatrick McHardy * separate class since they always nest. 476ef3eb3e5SPatrick McHardy */ 477ef3eb3e5SPatrick McHardy static struct lock_class_key vlan_netdev_xmit_lock_key; 478cf508b12SDavid S. Miller static struct lock_class_key vlan_netdev_addr_lock_key; 479ef3eb3e5SPatrick McHardy 480e8a0464cSDavid S. Miller static void vlan_dev_set_lockdep_one(struct net_device *dev, 481e8a0464cSDavid S. Miller struct netdev_queue *txq, 482e8a0464cSDavid S. Miller void *_subclass) 483c773e847SDavid S. Miller { 484c773e847SDavid S. Miller lockdep_set_class_and_subclass(&txq->_xmit_lock, 485e8a0464cSDavid S. Miller &vlan_netdev_xmit_lock_key, 486e8a0464cSDavid S. Miller *(int *)_subclass); 487c773e847SDavid S. Miller } 488c773e847SDavid S. Miller 489c773e847SDavid S. Miller static void vlan_dev_set_lockdep_class(struct net_device *dev, int subclass) 490c773e847SDavid S. Miller { 491cf508b12SDavid S. Miller lockdep_set_class_and_subclass(&dev->addr_list_lock, 492cf508b12SDavid S. Miller &vlan_netdev_addr_lock_key, 493cf508b12SDavid S. Miller subclass); 494e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, vlan_dev_set_lockdep_one, &subclass); 495c773e847SDavid S. Miller } 496c773e847SDavid S. Miller 497d38569abSVlad Yasevich static int vlan_dev_get_lock_subclass(struct net_device *dev) 498d38569abSVlad Yasevich { 499d38569abSVlad Yasevich return vlan_dev_priv(dev)->nest_level; 500d38569abSVlad Yasevich } 501d38569abSVlad Yasevich 502ef3eb3e5SPatrick McHardy static const struct header_ops vlan_header_ops = { 503ef3eb3e5SPatrick McHardy .create = vlan_dev_hard_header, 504ef3eb3e5SPatrick McHardy .parse = eth_header_parse, 505ef3eb3e5SPatrick McHardy }; 506ef3eb3e5SPatrick McHardy 5072205369aSDavid S. Miller static int vlan_passthru_hard_header(struct sk_buff *skb, struct net_device *dev, 5082205369aSDavid S. Miller unsigned short type, 5092205369aSDavid S. Miller const void *daddr, const void *saddr, 5102205369aSDavid S. Miller unsigned int len) 5112205369aSDavid S. Miller { 5122205369aSDavid S. Miller struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 5132205369aSDavid S. Miller struct net_device *real_dev = vlan->real_dev; 5142205369aSDavid S. Miller 515dd38743bSPeter Boström if (saddr == NULL) 516dd38743bSPeter Boström saddr = dev->dev_addr; 517dd38743bSPeter Boström 5182205369aSDavid S. Miller return dev_hard_header(skb, real_dev, type, daddr, saddr, len); 5192205369aSDavid S. Miller } 5202205369aSDavid S. Miller 5212205369aSDavid S. Miller static const struct header_ops vlan_passthru_header_ops = { 5222205369aSDavid S. Miller .create = vlan_passthru_hard_header, 5232205369aSDavid S. Miller .parse = eth_header_parse, 5242205369aSDavid S. Miller }; 5252205369aSDavid S. Miller 526e949b09bSDoug Goldstein static struct device_type vlan_type = { 527e949b09bSDoug Goldstein .name = "vlan", 528e949b09bSDoug Goldstein }; 529e949b09bSDoug Goldstein 530213b15caSEric Dumazet static const struct net_device_ops vlan_netdev_ops; 531f7d1b9f5SEric Dumazet 532ef3eb3e5SPatrick McHardy static int vlan_dev_init(struct net_device *dev) 533ef3eb3e5SPatrick McHardy { 5347da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 535ef3eb3e5SPatrick McHardy 536adc667e8SJay Vosburgh netif_carrier_off(dev); 537adc667e8SJay Vosburgh 538ef3eb3e5SPatrick McHardy /* IFF_BROADCAST|IFF_MULTICAST; ??? */ 539194dbcc8SJohn Fastabend dev->flags = real_dev->flags & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI | 540194dbcc8SJohn Fastabend IFF_MASTER | IFF_SLAVE); 541ef3eb3e5SPatrick McHardy dev->iflink = real_dev->ifindex; 542ef3eb3e5SPatrick McHardy dev->state = (real_dev->state & ((1<<__LINK_STATE_NOCARRIER) | 543ef3eb3e5SPatrick McHardy (1<<__LINK_STATE_DORMANT))) | 544ef3eb3e5SPatrick McHardy (1<<__LINK_STATE_PRESENT); 545ef3eb3e5SPatrick McHardy 54662f2a3a4SMichał Mirosław dev->hw_features = NETIF_F_ALL_CSUM | NETIF_F_SG | 54753f6b708SToshiaki Makita NETIF_F_FRAGLIST | NETIF_F_GSO_SOFTWARE | 54862f2a3a4SMichał Mirosław NETIF_F_HIGHDMA | NETIF_F_SCTP_CSUM | 54962f2a3a4SMichał Mirosław NETIF_F_ALL_FCOE; 55062f2a3a4SMichał Mirosław 55153f6b708SToshiaki Makita dev->features |= real_dev->vlan_features | NETIF_F_LLTX | 55253f6b708SToshiaki Makita NETIF_F_GSO_SOFTWARE; 5531ae4be22SAlexander Duyck dev->gso_max_size = real_dev->gso_max_size; 5542adb956bSVlad Yasevich if (dev->features & NETIF_F_VLAN_FEATURES) 5552adb956bSVlad Yasevich netdev_warn(real_dev, "VLAN features are set incorrectly. Q-in-Q configurations may not work correctly.\n"); 5562adb956bSVlad Yasevich 5578d463504SToshiaki Makita dev->vlan_features = real_dev->vlan_features & ~NETIF_F_ALL_FCOE; 5585fb13570SPatrick McHardy 559ef3eb3e5SPatrick McHardy /* ipv6 shared card related stuff */ 560ef3eb3e5SPatrick McHardy dev->dev_id = real_dev->dev_id; 561ef3eb3e5SPatrick McHardy 562ef3eb3e5SPatrick McHardy if (is_zero_ether_addr(dev->dev_addr)) 5636b93f4a1SBjørn Mork eth_hw_addr_inherit(dev, real_dev); 564ef3eb3e5SPatrick McHardy if (is_zero_ether_addr(dev->broadcast)) 565ef3eb3e5SPatrick McHardy memcpy(dev->broadcast, real_dev->broadcast, dev->addr_len); 566ef3eb3e5SPatrick McHardy 567f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 568b85daa53SVasu Dev dev->fcoe_ddp_xid = real_dev->fcoe_ddp_xid; 569b85daa53SVasu Dev #endif 570b85daa53SVasu Dev 571d870bfb9SEric Dumazet dev->needed_headroom = real_dev->needed_headroom; 572fc0d48b8SVlad Yasevich if (vlan_hw_offload_capable(real_dev->features, 573fc0d48b8SVlad Yasevich vlan_dev_priv(dev)->vlan_proto)) { 5742205369aSDavid S. Miller dev->header_ops = &vlan_passthru_header_ops; 575ef3eb3e5SPatrick McHardy dev->hard_header_len = real_dev->hard_header_len; 576ef3eb3e5SPatrick McHardy } else { 577ef3eb3e5SPatrick McHardy dev->header_ops = &vlan_header_ops; 578ef3eb3e5SPatrick McHardy dev->hard_header_len = real_dev->hard_header_len + VLAN_HLEN; 579636e19a3SJohn Fastabend } 580636e19a3SJohn Fastabend 581f7d1b9f5SEric Dumazet dev->netdev_ops = &vlan_netdev_ops; 582ef3eb3e5SPatrick McHardy 583e949b09bSDoug Goldstein SET_NETDEV_DEVTYPE(dev, &vlan_type); 584e949b09bSDoug Goldstein 585d38569abSVlad Yasevich vlan_dev_set_lockdep_class(dev, vlan_dev_get_lock_subclass(dev)); 5869793241fSEric Dumazet 5871c213bd2SWANG Cong vlan_dev_priv(dev)->vlan_pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats); 5887da82c06SJiri Pirko if (!vlan_dev_priv(dev)->vlan_pcpu_stats) 5899793241fSEric Dumazet return -ENOMEM; 5909793241fSEric Dumazet 591ef3eb3e5SPatrick McHardy return 0; 592ef3eb3e5SPatrick McHardy } 593ef3eb3e5SPatrick McHardy 59423556323SPavel Emelyanov static void vlan_dev_uninit(struct net_device *dev) 59523556323SPavel Emelyanov { 59623556323SPavel Emelyanov struct vlan_priority_tci_mapping *pm; 5977da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 59823556323SPavel Emelyanov int i; 59923556323SPavel Emelyanov 60023556323SPavel Emelyanov for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) { 60123556323SPavel Emelyanov while ((pm = vlan->egress_priority_map[i]) != NULL) { 60223556323SPavel Emelyanov vlan->egress_priority_map[i] = pm->next; 60323556323SPavel Emelyanov kfree(pm); 60423556323SPavel Emelyanov } 60523556323SPavel Emelyanov } 60623556323SPavel Emelyanov } 60723556323SPavel Emelyanov 608c8f44affSMichał Mirosław static netdev_features_t vlan_dev_fix_features(struct net_device *dev, 609c8f44affSMichał Mirosław netdev_features_t features) 6108a0427bbSMichał Mirosław { 6117da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 612b29d3145SBjørn Mork netdev_features_t old_features = features; 6138a0427bbSMichał Mirosław 614da08143bSMichal Kubeček features = netdev_intersect_features(features, real_dev->vlan_features); 615bc5787c6SMichał Mirosław features |= NETIF_F_RXCSUM; 616da08143bSMichal Kubeček features = netdev_intersect_features(features, real_dev->features); 617712ae51aSShan Wei 61853f6b708SToshiaki Makita features |= old_features & (NETIF_F_SOFT_FEATURES | NETIF_F_GSO_SOFTWARE); 619f0a619ccSMichał Mirosław features |= NETIF_F_LLTX; 6208a0427bbSMichał Mirosław 6218a0427bbSMichał Mirosław return features; 6228a0427bbSMichał Mirosław } 6238a0427bbSMichał Mirosław 624b3020061SStephen Hemminger static int vlan_ethtool_get_settings(struct net_device *dev, 625b3020061SStephen Hemminger struct ethtool_cmd *cmd) 626b3020061SStephen Hemminger { 6277da82c06SJiri Pirko const struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 6284bc71cb9SJiri Pirko 6294bc71cb9SJiri Pirko return __ethtool_get_settings(vlan->real_dev, cmd); 630b3020061SStephen Hemminger } 631b3020061SStephen Hemminger 632b3020061SStephen Hemminger static void vlan_ethtool_get_drvinfo(struct net_device *dev, 633b3020061SStephen Hemminger struct ethtool_drvinfo *info) 634b3020061SStephen Hemminger { 6357826d43fSJiri Pirko strlcpy(info->driver, vlan_fullname, sizeof(info->driver)); 6367826d43fSJiri Pirko strlcpy(info->version, vlan_version, sizeof(info->version)); 6377826d43fSJiri Pirko strlcpy(info->fw_version, "N/A", sizeof(info->fw_version)); 638b3020061SStephen Hemminger } 639b3020061SStephen Hemminger 64037dd9255SRichard Cochran static int vlan_ethtool_get_ts_info(struct net_device *dev, 64137dd9255SRichard Cochran struct ethtool_ts_info *info) 64237dd9255SRichard Cochran { 64337dd9255SRichard Cochran const struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 64437dd9255SRichard Cochran const struct ethtool_ops *ops = vlan->real_dev->ethtool_ops; 64537dd9255SRichard Cochran 64637dd9255SRichard Cochran if (ops->get_ts_info) { 64737dd9255SRichard Cochran return ops->get_ts_info(vlan->real_dev, info); 64837dd9255SRichard Cochran } else { 64937dd9255SRichard Cochran info->so_timestamping = SOF_TIMESTAMPING_RX_SOFTWARE | 65037dd9255SRichard Cochran SOF_TIMESTAMPING_SOFTWARE; 65137dd9255SRichard Cochran info->phc_index = -1; 65237dd9255SRichard Cochran } 65337dd9255SRichard Cochran 65437dd9255SRichard Cochran return 0; 65537dd9255SRichard Cochran } 65637dd9255SRichard Cochran 65728172739SEric Dumazet static struct rtnl_link_stats64 *vlan_dev_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats) 6589793241fSEric Dumazet { 6594af429d2SEric Dumazet struct vlan_pcpu_stats *p; 6604af429d2SEric Dumazet u32 rx_errors = 0, tx_dropped = 0; 6619793241fSEric Dumazet int i; 6629793241fSEric Dumazet 6639793241fSEric Dumazet for_each_possible_cpu(i) { 6644af429d2SEric Dumazet u64 rxpackets, rxbytes, rxmulticast, txpackets, txbytes; 6659618e2ffSEric Dumazet unsigned int start; 6669618e2ffSEric Dumazet 6677da82c06SJiri Pirko p = per_cpu_ptr(vlan_dev_priv(dev)->vlan_pcpu_stats, i); 6689618e2ffSEric Dumazet do { 66957a7744eSEric W. Biederman start = u64_stats_fetch_begin_irq(&p->syncp); 6709618e2ffSEric Dumazet rxpackets = p->rx_packets; 6719618e2ffSEric Dumazet rxbytes = p->rx_bytes; 6729618e2ffSEric Dumazet rxmulticast = p->rx_multicast; 6734af429d2SEric Dumazet txpackets = p->tx_packets; 6744af429d2SEric Dumazet txbytes = p->tx_bytes; 67557a7744eSEric W. Biederman } while (u64_stats_fetch_retry_irq(&p->syncp, start)); 6764af429d2SEric Dumazet 6774af429d2SEric Dumazet stats->rx_packets += rxpackets; 6784af429d2SEric Dumazet stats->rx_bytes += rxbytes; 6794af429d2SEric Dumazet stats->multicast += rxmulticast; 6804af429d2SEric Dumazet stats->tx_packets += txpackets; 6814af429d2SEric Dumazet stats->tx_bytes += txbytes; 6824af429d2SEric Dumazet /* rx_errors & tx_dropped are u32 */ 6834af429d2SEric Dumazet rx_errors += p->rx_errors; 6844af429d2SEric Dumazet tx_dropped += p->tx_dropped; 6859793241fSEric Dumazet } 6864af429d2SEric Dumazet stats->rx_errors = rx_errors; 6874af429d2SEric Dumazet stats->tx_dropped = tx_dropped; 6885a4ae5f6SLi RongQing 6899793241fSEric Dumazet return stats; 6909793241fSEric Dumazet } 6919793241fSEric Dumazet 6926d4cdf47SBenjamin LaHaise #ifdef CONFIG_NET_POLL_CONTROLLER 693de93cb2eSEric Dumazet static void vlan_dev_poll_controller(struct net_device *dev) 6946d4cdf47SBenjamin LaHaise { 6956d4cdf47SBenjamin LaHaise return; 6966d4cdf47SBenjamin LaHaise } 6976d4cdf47SBenjamin LaHaise 698a8779ec1SEric W. Biederman static int vlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo) 6996d4cdf47SBenjamin LaHaise { 700f3da3893SAmerigo Wang struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 701f3da3893SAmerigo Wang struct net_device *real_dev = vlan->real_dev; 7026d4cdf47SBenjamin LaHaise struct netpoll *netpoll; 7036d4cdf47SBenjamin LaHaise int err = 0; 7046d4cdf47SBenjamin LaHaise 705a8779ec1SEric W. Biederman netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL); 7066d4cdf47SBenjamin LaHaise err = -ENOMEM; 7076d4cdf47SBenjamin LaHaise if (!netpoll) 7086d4cdf47SBenjamin LaHaise goto out; 7096d4cdf47SBenjamin LaHaise 710a8779ec1SEric W. Biederman err = __netpoll_setup(netpoll, real_dev); 7116d4cdf47SBenjamin LaHaise if (err) { 7126d4cdf47SBenjamin LaHaise kfree(netpoll); 7136d4cdf47SBenjamin LaHaise goto out; 7146d4cdf47SBenjamin LaHaise } 7156d4cdf47SBenjamin LaHaise 716f3da3893SAmerigo Wang vlan->netpoll = netpoll; 7176d4cdf47SBenjamin LaHaise 7186d4cdf47SBenjamin LaHaise out: 7196d4cdf47SBenjamin LaHaise return err; 7206d4cdf47SBenjamin LaHaise } 7216d4cdf47SBenjamin LaHaise 722de93cb2eSEric Dumazet static void vlan_dev_netpoll_cleanup(struct net_device *dev) 7236d4cdf47SBenjamin LaHaise { 724f3da3893SAmerigo Wang struct vlan_dev_priv *vlan= vlan_dev_priv(dev); 725f3da3893SAmerigo Wang struct netpoll *netpoll = vlan->netpoll; 7266d4cdf47SBenjamin LaHaise 7276d4cdf47SBenjamin LaHaise if (!netpoll) 7286d4cdf47SBenjamin LaHaise return; 7296d4cdf47SBenjamin LaHaise 730f3da3893SAmerigo Wang vlan->netpoll = NULL; 7316d4cdf47SBenjamin LaHaise 7322cde6acdSNeil Horman __netpoll_free_async(netpoll); 7336d4cdf47SBenjamin LaHaise } 7346d4cdf47SBenjamin LaHaise #endif /* CONFIG_NET_POLL_CONTROLLER */ 7356d4cdf47SBenjamin LaHaise 73675b8846aSPatrick McHardy static const struct ethtool_ops vlan_ethtool_ops = { 737b3020061SStephen Hemminger .get_settings = vlan_ethtool_get_settings, 738b3020061SStephen Hemminger .get_drvinfo = vlan_ethtool_get_drvinfo, 73975b8846aSPatrick McHardy .get_link = ethtool_op_get_link, 74037dd9255SRichard Cochran .get_ts_info = vlan_ethtool_get_ts_info, 74175b8846aSPatrick McHardy }; 74275b8846aSPatrick McHardy 743656299f7SStephen Hemminger static const struct net_device_ops vlan_netdev_ops = { 744656299f7SStephen Hemminger .ndo_change_mtu = vlan_dev_change_mtu, 745656299f7SStephen Hemminger .ndo_init = vlan_dev_init, 746656299f7SStephen Hemminger .ndo_uninit = vlan_dev_uninit, 747656299f7SStephen Hemminger .ndo_open = vlan_dev_open, 748656299f7SStephen Hemminger .ndo_stop = vlan_dev_stop, 749f7d1b9f5SEric Dumazet .ndo_start_xmit = vlan_dev_hard_start_xmit, 750f7d1b9f5SEric Dumazet .ndo_validate_addr = eth_validate_addr, 751f7d1b9f5SEric Dumazet .ndo_set_mac_address = vlan_dev_set_mac_address, 752f7d1b9f5SEric Dumazet .ndo_set_rx_mode = vlan_dev_set_rx_mode, 753f7d1b9f5SEric Dumazet .ndo_change_rx_flags = vlan_dev_change_rx_flags, 754f7d1b9f5SEric Dumazet .ndo_do_ioctl = vlan_dev_ioctl, 755cc883d16SFrank Blaschka .ndo_neigh_setup = vlan_dev_neigh_setup, 7569618e2ffSEric Dumazet .ndo_get_stats64 = vlan_dev_get_stats64, 757f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 758b85daa53SVasu Dev .ndo_fcoe_ddp_setup = vlan_dev_fcoe_ddp_setup, 759b85daa53SVasu Dev .ndo_fcoe_ddp_done = vlan_dev_fcoe_ddp_done, 7600af46d99SYi Zou .ndo_fcoe_enable = vlan_dev_fcoe_enable, 7610af46d99SYi Zou .ndo_fcoe_disable = vlan_dev_fcoe_disable, 762d6534799SYi Zou .ndo_fcoe_get_wwn = vlan_dev_fcoe_get_wwn, 7634ea09c9cSYi Zou .ndo_fcoe_ddp_target = vlan_dev_fcoe_ddp_target, 764b85daa53SVasu Dev #endif 7656d4cdf47SBenjamin LaHaise #ifdef CONFIG_NET_POLL_CONTROLLER 7666d4cdf47SBenjamin LaHaise .ndo_poll_controller = vlan_dev_poll_controller, 7676d4cdf47SBenjamin LaHaise .ndo_netpoll_setup = vlan_dev_netpoll_setup, 7686d4cdf47SBenjamin LaHaise .ndo_netpoll_cleanup = vlan_dev_netpoll_cleanup, 7696d4cdf47SBenjamin LaHaise #endif 7708a0427bbSMichał Mirosław .ndo_fix_features = vlan_dev_fix_features, 771d38569abSVlad Yasevich .ndo_get_lock_subclass = vlan_dev_get_lock_subclass, 772f7d1b9f5SEric Dumazet }; 773f7d1b9f5SEric Dumazet 774a48e5fafSEric Dumazet static void vlan_dev_free(struct net_device *dev) 775a48e5fafSEric Dumazet { 776a48e5fafSEric Dumazet struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 777a48e5fafSEric Dumazet 778a48e5fafSEric Dumazet free_percpu(vlan->vlan_pcpu_stats); 779a48e5fafSEric Dumazet vlan->vlan_pcpu_stats = NULL; 780a48e5fafSEric Dumazet free_netdev(dev); 781a48e5fafSEric Dumazet } 782a48e5fafSEric Dumazet 783ef3eb3e5SPatrick McHardy void vlan_setup(struct net_device *dev) 784ef3eb3e5SPatrick McHardy { 785ef3eb3e5SPatrick McHardy ether_setup(dev); 786ef3eb3e5SPatrick McHardy 787ef3eb3e5SPatrick McHardy dev->priv_flags |= IFF_802_1Q_VLAN; 78802875878SEric Dumazet dev->priv_flags &= ~IFF_TX_SKB_SHARING; 78902875878SEric Dumazet netif_keep_dst(dev); 790ef3eb3e5SPatrick McHardy dev->tx_queue_len = 0; 791ef3eb3e5SPatrick McHardy 792656299f7SStephen Hemminger dev->netdev_ops = &vlan_netdev_ops; 793a48e5fafSEric Dumazet dev->destructor = vlan_dev_free; 79475b8846aSPatrick McHardy dev->ethtool_ops = &vlan_ethtool_ops; 795ef3eb3e5SPatrick McHardy 796423049abSJoe Perches eth_zero_addr(dev->broadcast); 797ef3eb3e5SPatrick McHardy } 798