1243a2e63SVlad Yasevich #include <linux/kernel.h> 2243a2e63SVlad Yasevich #include <linux/netdevice.h> 3243a2e63SVlad Yasevich #include <linux/rtnetlink.h> 4243a2e63SVlad Yasevich #include <linux/slab.h> 57f109539SScott Feldman #include <net/switchdev.h> 6243a2e63SVlad Yasevich 7243a2e63SVlad Yasevich #include "br_private.h" 8efa5356bSRoopa Prabhu #include "br_private_tunnel.h" 9243a2e63SVlad Yasevich 102594e906SNikolay Aleksandrov static inline int br_vlan_cmp(struct rhashtable_compare_arg *arg, 112594e906SNikolay Aleksandrov const void *ptr) 12552406c4SVlad Yasevich { 132594e906SNikolay Aleksandrov const struct net_bridge_vlan *vle = ptr; 142594e906SNikolay Aleksandrov u16 vid = *(u16 *)arg->key; 152594e906SNikolay Aleksandrov 162594e906SNikolay Aleksandrov return vle->vid != vid; 172594e906SNikolay Aleksandrov } 182594e906SNikolay Aleksandrov 192594e906SNikolay Aleksandrov static const struct rhashtable_params br_vlan_rht_params = { 202594e906SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_vlan, vnode), 212594e906SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_vlan, vid), 222594e906SNikolay Aleksandrov .key_len = sizeof(u16), 238af78b64SNikolay Aleksandrov .nelem_hint = 3, 248af78b64SNikolay Aleksandrov .locks_mul = 1, 252594e906SNikolay Aleksandrov .max_size = VLAN_N_VID, 262594e906SNikolay Aleksandrov .obj_cmpfn = br_vlan_cmp, 272594e906SNikolay Aleksandrov .automatic_shrinking = true, 282594e906SNikolay Aleksandrov }; 292594e906SNikolay Aleksandrov 302594e906SNikolay Aleksandrov static struct net_bridge_vlan *br_vlan_lookup(struct rhashtable *tbl, u16 vid) 312594e906SNikolay Aleksandrov { 322594e906SNikolay Aleksandrov return rhashtable_lookup_fast(tbl, &vid, br_vlan_rht_params); 332594e906SNikolay Aleksandrov } 342594e906SNikolay Aleksandrov 3577751ee8SNikolay Aleksandrov static void __vlan_add_pvid(struct net_bridge_vlan_group *vg, u16 vid) 362594e906SNikolay Aleksandrov { 3777751ee8SNikolay Aleksandrov if (vg->pvid == vid) 38552406c4SVlad Yasevich return; 39552406c4SVlad Yasevich 40552406c4SVlad Yasevich smp_wmb(); 4177751ee8SNikolay Aleksandrov vg->pvid = vid; 42552406c4SVlad Yasevich } 43552406c4SVlad Yasevich 4477751ee8SNikolay Aleksandrov static void __vlan_delete_pvid(struct net_bridge_vlan_group *vg, u16 vid) 45552406c4SVlad Yasevich { 4677751ee8SNikolay Aleksandrov if (vg->pvid != vid) 47552406c4SVlad Yasevich return; 48552406c4SVlad Yasevich 49552406c4SVlad Yasevich smp_wmb(); 5077751ee8SNikolay Aleksandrov vg->pvid = 0; 51552406c4SVlad Yasevich } 52552406c4SVlad Yasevich 532594e906SNikolay Aleksandrov static void __vlan_add_flags(struct net_bridge_vlan *v, u16 flags) 5435e03f3aSVlad Yasevich { 5577751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 5677751ee8SNikolay Aleksandrov 572594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) 58907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 59635126b7SVlad Yasevich else 60907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 6177751ee8SNikolay Aleksandrov 6277751ee8SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_PVID) 6377751ee8SNikolay Aleksandrov __vlan_add_pvid(vg, v->vid); 642594e906SNikolay Aleksandrov else 6577751ee8SNikolay Aleksandrov __vlan_delete_pvid(vg, v->vid); 6635e03f3aSVlad Yasevich 6735e03f3aSVlad Yasevich if (flags & BRIDGE_VLAN_INFO_UNTAGGED) 682594e906SNikolay Aleksandrov v->flags |= BRIDGE_VLAN_INFO_UNTAGGED; 69635126b7SVlad Yasevich else 702594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_UNTAGGED; 7135e03f3aSVlad Yasevich } 7235e03f3aSVlad Yasevich 737f109539SScott Feldman static int __vlan_vid_add(struct net_device *dev, struct net_bridge *br, 747f109539SScott Feldman u16 vid, u16 flags) 757f109539SScott Feldman { 768f24f309SJiri Pirko struct switchdev_obj_port_vlan v = { 776ff64f6fSIdo Schimmel .obj.orig_dev = dev, 789e8f4a54SJiri Pirko .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN, 797f109539SScott Feldman .flags = flags, 803e3a78b4SScott Feldman .vid_begin = vid, 817f109539SScott Feldman .vid_end = vid, 827f109539SScott Feldman }; 830944d6b5SJiri Pirko int err; 847f109539SScott Feldman 850944d6b5SJiri Pirko /* Try switchdev op first. In case it is not supported, fallback to 860944d6b5SJiri Pirko * 8021q add. 870944d6b5SJiri Pirko */ 889e8f4a54SJiri Pirko err = switchdev_port_obj_add(dev, &v.obj); 897f109539SScott Feldman if (err == -EOPNOTSUPP) 900944d6b5SJiri Pirko return vlan_vid_add(dev, br->vlan_proto, vid); 917f109539SScott Feldman return err; 927f109539SScott Feldman } 937f109539SScott Feldman 942594e906SNikolay Aleksandrov static void __vlan_add_list(struct net_bridge_vlan *v) 95243a2e63SVlad Yasevich { 96907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 972594e906SNikolay Aleksandrov struct list_head *headp, *hpos; 982594e906SNikolay Aleksandrov struct net_bridge_vlan *vent; 99243a2e63SVlad Yasevich 100907b1e6eSNikolay Aleksandrov if (br_vlan_is_master(v)) 101907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 102907b1e6eSNikolay Aleksandrov else 103907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 104907b1e6eSNikolay Aleksandrov 105907b1e6eSNikolay Aleksandrov headp = &vg->vlan_list; 1062594e906SNikolay Aleksandrov list_for_each_prev(hpos, headp) { 1072594e906SNikolay Aleksandrov vent = list_entry(hpos, struct net_bridge_vlan, vlist); 1082594e906SNikolay Aleksandrov if (v->vid < vent->vid) 1092594e906SNikolay Aleksandrov continue; 1102594e906SNikolay Aleksandrov else 1112594e906SNikolay Aleksandrov break; 1122594e906SNikolay Aleksandrov } 113586c2b57SNikolay Aleksandrov list_add_rcu(&v->vlist, hpos); 114552406c4SVlad Yasevich } 115243a2e63SVlad Yasevich 1162594e906SNikolay Aleksandrov static void __vlan_del_list(struct net_bridge_vlan *v) 1172594e906SNikolay Aleksandrov { 118586c2b57SNikolay Aleksandrov list_del_rcu(&v->vlist); 119243a2e63SVlad Yasevich } 120243a2e63SVlad Yasevich 121bf361ad3SVivien Didelot static int __vlan_vid_del(struct net_device *dev, struct net_bridge *br, 1227f109539SScott Feldman u16 vid) 1237f109539SScott Feldman { 1248f24f309SJiri Pirko struct switchdev_obj_port_vlan v = { 1256ff64f6fSIdo Schimmel .obj.orig_dev = dev, 1269e8f4a54SJiri Pirko .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN, 1273e3a78b4SScott Feldman .vid_begin = vid, 1287f109539SScott Feldman .vid_end = vid, 1297f109539SScott Feldman }; 1300944d6b5SJiri Pirko int err; 1317f109539SScott Feldman 1320944d6b5SJiri Pirko /* Try switchdev op first. In case it is not supported, fallback to 1330944d6b5SJiri Pirko * 8021q del. 1340944d6b5SJiri Pirko */ 1359e8f4a54SJiri Pirko err = switchdev_port_obj_del(dev, &v.obj); 1360944d6b5SJiri Pirko if (err == -EOPNOTSUPP) { 1370944d6b5SJiri Pirko vlan_vid_del(dev, br->vlan_proto, vid); 1380944d6b5SJiri Pirko return 0; 1397f109539SScott Feldman } 140bf361ad3SVivien Didelot return err; 1417f109539SScott Feldman } 1427f109539SScott Feldman 143f8ed289fSNikolay Aleksandrov /* Returns a master vlan, if it didn't exist it gets created. In all cases a 144f8ed289fSNikolay Aleksandrov * a reference is taken to the master vlan before returning. 145f8ed289fSNikolay Aleksandrov */ 146f8ed289fSNikolay Aleksandrov static struct net_bridge_vlan *br_vlan_get_master(struct net_bridge *br, u16 vid) 147f8ed289fSNikolay Aleksandrov { 148907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 149f8ed289fSNikolay Aleksandrov struct net_bridge_vlan *masterv; 150f8ed289fSNikolay Aleksandrov 151907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 152907b1e6eSNikolay Aleksandrov masterv = br_vlan_find(vg, vid); 153f8ed289fSNikolay Aleksandrov if (!masterv) { 154f8ed289fSNikolay Aleksandrov /* missing global ctx, create it now */ 155f8ed289fSNikolay Aleksandrov if (br_vlan_add(br, vid, 0)) 156f8ed289fSNikolay Aleksandrov return NULL; 157907b1e6eSNikolay Aleksandrov masterv = br_vlan_find(vg, vid); 158f8ed289fSNikolay Aleksandrov if (WARN_ON(!masterv)) 159f8ed289fSNikolay Aleksandrov return NULL; 160f8ed289fSNikolay Aleksandrov } 16125127759SReshetova, Elena refcount_inc(&masterv->refcnt); 162f8ed289fSNikolay Aleksandrov 163f8ed289fSNikolay Aleksandrov return masterv; 164f8ed289fSNikolay Aleksandrov } 165f8ed289fSNikolay Aleksandrov 1666dada9b1SNikolay Aleksandrov static void br_master_vlan_rcu_free(struct rcu_head *rcu) 1676dada9b1SNikolay Aleksandrov { 1686dada9b1SNikolay Aleksandrov struct net_bridge_vlan *v; 1696dada9b1SNikolay Aleksandrov 1706dada9b1SNikolay Aleksandrov v = container_of(rcu, struct net_bridge_vlan, rcu); 1716dada9b1SNikolay Aleksandrov WARN_ON(!br_vlan_is_master(v)); 1726dada9b1SNikolay Aleksandrov free_percpu(v->stats); 1736dada9b1SNikolay Aleksandrov v->stats = NULL; 1746dada9b1SNikolay Aleksandrov kfree(v); 1756dada9b1SNikolay Aleksandrov } 1766dada9b1SNikolay Aleksandrov 177f8ed289fSNikolay Aleksandrov static void br_vlan_put_master(struct net_bridge_vlan *masterv) 178f8ed289fSNikolay Aleksandrov { 179907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 180907b1e6eSNikolay Aleksandrov 181f8ed289fSNikolay Aleksandrov if (!br_vlan_is_master(masterv)) 182f8ed289fSNikolay Aleksandrov return; 183f8ed289fSNikolay Aleksandrov 184907b1e6eSNikolay Aleksandrov vg = br_vlan_group(masterv->br); 18525127759SReshetova, Elena if (refcount_dec_and_test(&masterv->refcnt)) { 186907b1e6eSNikolay Aleksandrov rhashtable_remove_fast(&vg->vlan_hash, 187f8ed289fSNikolay Aleksandrov &masterv->vnode, br_vlan_rht_params); 188f8ed289fSNikolay Aleksandrov __vlan_del_list(masterv); 1896dada9b1SNikolay Aleksandrov call_rcu(&masterv->rcu, br_master_vlan_rcu_free); 190f8ed289fSNikolay Aleksandrov } 191f8ed289fSNikolay Aleksandrov } 192f8ed289fSNikolay Aleksandrov 1932594e906SNikolay Aleksandrov /* This is the shared VLAN add function which works for both ports and bridge 1942594e906SNikolay Aleksandrov * devices. There are four possible calls to this function in terms of the 1952594e906SNikolay Aleksandrov * vlan entry type: 1962594e906SNikolay Aleksandrov * 1. vlan is being added on a port (no master flags, global entry exists) 197ddd611d3SIdo Schimmel * 2. vlan is being added on a bridge (both master and brentry flags) 1982594e906SNikolay Aleksandrov * 3. vlan is being added on a port, but a global entry didn't exist which 199ddd611d3SIdo Schimmel * is being created right now (master flag set, brentry flag unset), the 2002594e906SNikolay Aleksandrov * global entry is used for global per-vlan features, but not for filtering 201ddd611d3SIdo Schimmel * 4. same as 3 but with both master and brentry flags set so the entry 2022594e906SNikolay Aleksandrov * will be used for filtering in both the port and the bridge 2032594e906SNikolay Aleksandrov */ 2042594e906SNikolay Aleksandrov static int __vlan_add(struct net_bridge_vlan *v, u16 flags) 205243a2e63SVlad Yasevich { 2062594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = NULL; 2072594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 2086be144f6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 2092594e906SNikolay Aleksandrov struct net_device *dev; 2102594e906SNikolay Aleksandrov struct net_bridge *br; 211bf361ad3SVivien Didelot int err; 212bf361ad3SVivien Didelot 2132594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 2142594e906SNikolay Aleksandrov br = v->br; 2152594e906SNikolay Aleksandrov dev = br->dev; 216907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 2172594e906SNikolay Aleksandrov } else { 2182594e906SNikolay Aleksandrov p = v->port; 2192594e906SNikolay Aleksandrov br = p->br; 2202594e906SNikolay Aleksandrov dev = p->dev; 221907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 2222594e906SNikolay Aleksandrov } 2232594e906SNikolay Aleksandrov 2242594e906SNikolay Aleksandrov if (p) { 2252594e906SNikolay Aleksandrov /* Add VLAN to the device filter if it is supported. 2262594e906SNikolay Aleksandrov * This ensures tagged traffic enters the bridge when 2272594e906SNikolay Aleksandrov * promiscuous mode is disabled by br_manage_promisc(). 2282594e906SNikolay Aleksandrov */ 2292594e906SNikolay Aleksandrov err = __vlan_vid_add(dev, br, v->vid, flags); 230bf361ad3SVivien Didelot if (err) 2312594e906SNikolay Aleksandrov goto out; 2322594e906SNikolay Aleksandrov 2332594e906SNikolay Aleksandrov /* need to work on the master vlan too */ 2342594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_MASTER) { 2352ffdf508SNikolay Aleksandrov err = br_vlan_add(br, v->vid, flags | 2362ffdf508SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY); 2372594e906SNikolay Aleksandrov if (err) 2382594e906SNikolay Aleksandrov goto out_filt; 2392594e906SNikolay Aleksandrov } 2402594e906SNikolay Aleksandrov 241f8ed289fSNikolay Aleksandrov masterv = br_vlan_get_master(br, v->vid); 242f8ed289fSNikolay Aleksandrov if (!masterv) 2432594e906SNikolay Aleksandrov goto out_filt; 2442594e906SNikolay Aleksandrov v->brvlan = masterv; 2456dada9b1SNikolay Aleksandrov v->stats = masterv->stats; 2462594e906SNikolay Aleksandrov } 2472594e906SNikolay Aleksandrov 2486be144f6SNikolay Aleksandrov /* Add the dev mac and count the vlan only if it's usable */ 2492594e906SNikolay Aleksandrov if (br_vlan_should_use(v)) { 2502594e906SNikolay Aleksandrov err = br_fdb_insert(br, p, dev->dev_addr, v->vid); 2512594e906SNikolay Aleksandrov if (err) { 2522594e906SNikolay Aleksandrov br_err(br, "failed insert local address into bridge forwarding table\n"); 2532594e906SNikolay Aleksandrov goto out_filt; 2542594e906SNikolay Aleksandrov } 2556be144f6SNikolay Aleksandrov vg->num_vlans++; 2562594e906SNikolay Aleksandrov } 2572594e906SNikolay Aleksandrov 2586be144f6SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&vg->vlan_hash, &v->vnode, 2596be144f6SNikolay Aleksandrov br_vlan_rht_params); 2602594e906SNikolay Aleksandrov if (err) 2612594e906SNikolay Aleksandrov goto out_fdb_insert; 2622594e906SNikolay Aleksandrov 2632594e906SNikolay Aleksandrov __vlan_add_list(v); 2642594e906SNikolay Aleksandrov __vlan_add_flags(v, flags); 2652594e906SNikolay Aleksandrov out: 2662594e906SNikolay Aleksandrov return err; 2672594e906SNikolay Aleksandrov 2682594e906SNikolay Aleksandrov out_fdb_insert: 2696be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 2706be144f6SNikolay Aleksandrov br_fdb_find_delete_local(br, p, dev->dev_addr, v->vid); 2716be144f6SNikolay Aleksandrov vg->num_vlans--; 2726be144f6SNikolay Aleksandrov } 2732594e906SNikolay Aleksandrov 2742594e906SNikolay Aleksandrov out_filt: 2752594e906SNikolay Aleksandrov if (p) { 2762594e906SNikolay Aleksandrov __vlan_vid_del(dev, br, v->vid); 2772594e906SNikolay Aleksandrov if (masterv) { 278f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 2792594e906SNikolay Aleksandrov v->brvlan = NULL; 2802594e906SNikolay Aleksandrov } 2812594e906SNikolay Aleksandrov } 2822594e906SNikolay Aleksandrov 2832594e906SNikolay Aleksandrov goto out; 2842594e906SNikolay Aleksandrov } 2852594e906SNikolay Aleksandrov 2862594e906SNikolay Aleksandrov static int __vlan_del(struct net_bridge_vlan *v) 2872594e906SNikolay Aleksandrov { 2882594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = v; 28977751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 2902594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 2912594e906SNikolay Aleksandrov int err = 0; 2922594e906SNikolay Aleksandrov 2932594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 294907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 2952594e906SNikolay Aleksandrov } else { 2962594e906SNikolay Aleksandrov p = v->port; 297907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 2982594e906SNikolay Aleksandrov masterv = v->brvlan; 2992594e906SNikolay Aleksandrov } 3002594e906SNikolay Aleksandrov 30177751ee8SNikolay Aleksandrov __vlan_delete_pvid(vg, v->vid); 3022594e906SNikolay Aleksandrov if (p) { 3032594e906SNikolay Aleksandrov err = __vlan_vid_del(p->dev, p->br, v->vid); 3042594e906SNikolay Aleksandrov if (err) 3052594e906SNikolay Aleksandrov goto out; 3062594e906SNikolay Aleksandrov } 3072594e906SNikolay Aleksandrov 3086be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 3092594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_BRENTRY; 3106be144f6SNikolay Aleksandrov vg->num_vlans--; 3112594e906SNikolay Aleksandrov } 3122594e906SNikolay Aleksandrov 3132594e906SNikolay Aleksandrov if (masterv != v) { 314efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 31577751ee8SNikolay Aleksandrov rhashtable_remove_fast(&vg->vlan_hash, &v->vnode, 31677751ee8SNikolay Aleksandrov br_vlan_rht_params); 3172594e906SNikolay Aleksandrov __vlan_del_list(v); 3182594e906SNikolay Aleksandrov kfree_rcu(v, rcu); 3192594e906SNikolay Aleksandrov } 3202594e906SNikolay Aleksandrov 321f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 3222594e906SNikolay Aleksandrov out: 323bf361ad3SVivien Didelot return err; 3248580e211SToshiaki Makita } 325243a2e63SVlad Yasevich 326f409d0edSNikolay Aleksandrov static void __vlan_group_free(struct net_bridge_vlan_group *vg) 327f409d0edSNikolay Aleksandrov { 328f409d0edSNikolay Aleksandrov WARN_ON(!list_empty(&vg->vlan_list)); 329f409d0edSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 330efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 331f409d0edSNikolay Aleksandrov kfree(vg); 332f409d0edSNikolay Aleksandrov } 333f409d0edSNikolay Aleksandrov 334f409d0edSNikolay Aleksandrov static void __vlan_flush(struct net_bridge_vlan_group *vg) 335243a2e63SVlad Yasevich { 3362594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan, *tmp; 3372594e906SNikolay Aleksandrov 338f409d0edSNikolay Aleksandrov __vlan_delete_pvid(vg, vg->pvid); 339f409d0edSNikolay Aleksandrov list_for_each_entry_safe(vlan, tmp, &vg->vlan_list, vlist) 3402594e906SNikolay Aleksandrov __vlan_del(vlan); 341243a2e63SVlad Yasevich } 342243a2e63SVlad Yasevich 34378851988SVlad Yasevich struct sk_buff *br_handle_vlan(struct net_bridge *br, 34411538d03SRoopa Prabhu const struct net_bridge_port *p, 3452594e906SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 346a37b85c9SVlad Yasevich struct sk_buff *skb) 347a37b85c9SVlad Yasevich { 3486dada9b1SNikolay Aleksandrov struct br_vlan_stats *stats; 3492594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 350a37b85c9SVlad Yasevich u16 vid; 351a37b85c9SVlad Yasevich 35220adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 35320adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 35478851988SVlad Yasevich goto out; 35578851988SVlad Yasevich 3562594e906SNikolay Aleksandrov /* At this point, we know that the frame was filtered and contains 3572594e906SNikolay Aleksandrov * a valid vlan id. If the vlan id has untagged flag set, 3582594e906SNikolay Aleksandrov * send untagged; otherwise, send tagged. 3592594e906SNikolay Aleksandrov */ 3602594e906SNikolay Aleksandrov br_vlan_get_tag(skb, &vid); 3612594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 3622594e906SNikolay Aleksandrov /* Vlan entry must be configured at this point. The 363fc92f745SVlad Yasevich * only exception is the bridge is set in promisc mode and the 364fc92f745SVlad Yasevich * packet is destined for the bridge device. In this case 365fc92f745SVlad Yasevich * pass the packet as is. 366fc92f745SVlad Yasevich */ 3672594e906SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) { 368fc92f745SVlad Yasevich if ((br->dev->flags & IFF_PROMISC) && skb->dev == br->dev) { 369fc92f745SVlad Yasevich goto out; 370fc92f745SVlad Yasevich } else { 371fc92f745SVlad Yasevich kfree_skb(skb); 372fc92f745SVlad Yasevich return NULL; 373fc92f745SVlad Yasevich } 374fc92f745SVlad Yasevich } 3756dada9b1SNikolay Aleksandrov if (br->vlan_stats_enabled) { 3766dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 3776dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 3786dada9b1SNikolay Aleksandrov stats->tx_bytes += skb->len; 3796dada9b1SNikolay Aleksandrov stats->tx_packets++; 3806dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 3816dada9b1SNikolay Aleksandrov } 3826dada9b1SNikolay Aleksandrov 3832594e906SNikolay Aleksandrov if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED) 38499b192daSToshiaki Makita skb->vlan_tci = 0; 38511538d03SRoopa Prabhu 38611538d03SRoopa Prabhu if (p && (p->flags & BR_VLAN_TUNNEL) && 38711538d03SRoopa Prabhu br_handle_egress_vlan_tunnel(skb, v)) { 38811538d03SRoopa Prabhu kfree_skb(skb); 38911538d03SRoopa Prabhu return NULL; 39011538d03SRoopa Prabhu } 39178851988SVlad Yasevich out: 39278851988SVlad Yasevich return skb; 39378851988SVlad Yasevich } 39478851988SVlad Yasevich 39578851988SVlad Yasevich /* Called under RCU */ 3966dada9b1SNikolay Aleksandrov static bool __allowed_ingress(const struct net_bridge *br, 3976dada9b1SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 39878851988SVlad Yasevich struct sk_buff *skb, u16 *vid) 39978851988SVlad Yasevich { 4006dada9b1SNikolay Aleksandrov struct br_vlan_stats *stats; 4016dada9b1SNikolay Aleksandrov struct net_bridge_vlan *v; 4028580e211SToshiaki Makita bool tagged; 403a37b85c9SVlad Yasevich 40420adfa1aSVlad Yasevich BR_INPUT_SKB_CB(skb)->vlan_filtered = true; 40512464bb8SToshiaki Makita /* If vlan tx offload is disabled on bridge device and frame was 40612464bb8SToshiaki Makita * sent from vlan device on the bridge device, it does not have 40712464bb8SToshiaki Makita * HW accelerated vlan tag. 40812464bb8SToshiaki Makita */ 409df8a39deSJiri Pirko if (unlikely(!skb_vlan_tag_present(skb) && 4106dada9b1SNikolay Aleksandrov skb->protocol == br->vlan_proto)) { 4110d5501c1SVlad Yasevich skb = skb_vlan_untag(skb); 41212464bb8SToshiaki Makita if (unlikely(!skb)) 41312464bb8SToshiaki Makita return false; 41412464bb8SToshiaki Makita } 41512464bb8SToshiaki Makita 4168580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid)) { 4178580e211SToshiaki Makita /* Tagged frame */ 4186dada9b1SNikolay Aleksandrov if (skb->vlan_proto != br->vlan_proto) { 4198580e211SToshiaki Makita /* Protocol-mismatch, empty out vlan_tci for new tag */ 4208580e211SToshiaki Makita skb_push(skb, ETH_HLEN); 42162749e2cSJiri Pirko skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto, 422df8a39deSJiri Pirko skb_vlan_tag_get(skb)); 4238580e211SToshiaki Makita if (unlikely(!skb)) 4248580e211SToshiaki Makita return false; 4258580e211SToshiaki Makita 4268580e211SToshiaki Makita skb_pull(skb, ETH_HLEN); 4278580e211SToshiaki Makita skb_reset_mac_len(skb); 4288580e211SToshiaki Makita *vid = 0; 4298580e211SToshiaki Makita tagged = false; 4308580e211SToshiaki Makita } else { 4318580e211SToshiaki Makita tagged = true; 4328580e211SToshiaki Makita } 4338580e211SToshiaki Makita } else { 4348580e211SToshiaki Makita /* Untagged frame */ 4358580e211SToshiaki Makita tagged = false; 4368580e211SToshiaki Makita } 4378580e211SToshiaki Makita 438b90356ceSToshiaki Makita if (!*vid) { 43977751ee8SNikolay Aleksandrov u16 pvid = br_get_pvid(vg); 44077751ee8SNikolay Aleksandrov 441b90356ceSToshiaki Makita /* Frame had a tag with VID 0 or did not have a tag. 442b90356ceSToshiaki Makita * See if pvid is set on this port. That tells us which 443b90356ceSToshiaki Makita * vlan untagged or priority-tagged traffic belongs to. 44478851988SVlad Yasevich */ 4453df6bf45SVlad Yasevich if (!pvid) 446eb707618SToshiaki Makita goto drop; 44778851988SVlad Yasevich 448b90356ceSToshiaki Makita /* PVID is set on this port. Any untagged or priority-tagged 449b90356ceSToshiaki Makita * ingress frame is considered to belong to this vlan. 45078851988SVlad Yasevich */ 451dfb5fa32SToshiaki Makita *vid = pvid; 4528580e211SToshiaki Makita if (likely(!tagged)) 453b90356ceSToshiaki Makita /* Untagged Frame. */ 4546dada9b1SNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, br->vlan_proto, pvid); 455b90356ceSToshiaki Makita else 456b90356ceSToshiaki Makita /* Priority-tagged Frame. 457b90356ceSToshiaki Makita * At this point, We know that skb->vlan_tci had 458b90356ceSToshiaki Makita * VLAN_TAG_PRESENT bit and its VID field was 0x000. 459b90356ceSToshiaki Makita * We update only VID field and preserve PCP field. 460b90356ceSToshiaki Makita */ 461b90356ceSToshiaki Makita skb->vlan_tci |= pvid; 462b90356ceSToshiaki Makita 4636dada9b1SNikolay Aleksandrov /* if stats are disabled we can avoid the lookup */ 4646dada9b1SNikolay Aleksandrov if (!br->vlan_stats_enabled) 46578851988SVlad Yasevich return true; 46678851988SVlad Yasevich } 46777751ee8SNikolay Aleksandrov v = br_vlan_find(vg, *vid); 4686dada9b1SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) 4696dada9b1SNikolay Aleksandrov goto drop; 4706dada9b1SNikolay Aleksandrov 4716dada9b1SNikolay Aleksandrov if (br->vlan_stats_enabled) { 4726dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 4736dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 4746dada9b1SNikolay Aleksandrov stats->rx_bytes += skb->len; 4756dada9b1SNikolay Aleksandrov stats->rx_packets++; 4766dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 4776dada9b1SNikolay Aleksandrov } 4786dada9b1SNikolay Aleksandrov 479a37b85c9SVlad Yasevich return true; 4806dada9b1SNikolay Aleksandrov 481eb707618SToshiaki Makita drop: 482eb707618SToshiaki Makita kfree_skb(skb); 483a37b85c9SVlad Yasevich return false; 484a37b85c9SVlad Yasevich } 485a37b85c9SVlad Yasevich 48677751ee8SNikolay Aleksandrov bool br_allowed_ingress(const struct net_bridge *br, 48777751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg, struct sk_buff *skb, 4882594e906SNikolay Aleksandrov u16 *vid) 4892594e906SNikolay Aleksandrov { 4902594e906SNikolay Aleksandrov /* If VLAN filtering is disabled on the bridge, all packets are 4912594e906SNikolay Aleksandrov * permitted. 4922594e906SNikolay Aleksandrov */ 4932594e906SNikolay Aleksandrov if (!br->vlan_enabled) { 4942594e906SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->vlan_filtered = false; 4952594e906SNikolay Aleksandrov return true; 4962594e906SNikolay Aleksandrov } 4972594e906SNikolay Aleksandrov 4986dada9b1SNikolay Aleksandrov return __allowed_ingress(br, vg, skb, vid); 4992594e906SNikolay Aleksandrov } 5002594e906SNikolay Aleksandrov 50185f46c6bSVlad Yasevich /* Called under RCU. */ 5022594e906SNikolay Aleksandrov bool br_allowed_egress(struct net_bridge_vlan_group *vg, 50385f46c6bSVlad Yasevich const struct sk_buff *skb) 50485f46c6bSVlad Yasevich { 5052594e906SNikolay Aleksandrov const struct net_bridge_vlan *v; 50685f46c6bSVlad Yasevich u16 vid; 50785f46c6bSVlad Yasevich 50820adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 50920adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 51085f46c6bSVlad Yasevich return true; 51185f46c6bSVlad Yasevich 51285f46c6bSVlad Yasevich br_vlan_get_tag(skb, &vid); 5132594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 5142594e906SNikolay Aleksandrov if (v && br_vlan_should_use(v)) 51585f46c6bSVlad Yasevich return true; 51685f46c6bSVlad Yasevich 51785f46c6bSVlad Yasevich return false; 51885f46c6bSVlad Yasevich } 51985f46c6bSVlad Yasevich 520e0d7968aSToshiaki Makita /* Called under RCU */ 521e0d7968aSToshiaki Makita bool br_should_learn(struct net_bridge_port *p, struct sk_buff *skb, u16 *vid) 522e0d7968aSToshiaki Makita { 523468e7944SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 524e0d7968aSToshiaki Makita struct net_bridge *br = p->br; 525e0d7968aSToshiaki Makita 52620adfa1aSVlad Yasevich /* If filtering was disabled at input, let it pass. */ 527c095f248SVlad Yasevich if (!br->vlan_enabled) 528e0d7968aSToshiaki Makita return true; 529e0d7968aSToshiaki Makita 530eca1e006SIdo Schimmel vg = nbp_vlan_group_rcu(p); 531468e7944SNikolay Aleksandrov if (!vg || !vg->num_vlans) 532e0d7968aSToshiaki Makita return false; 533e0d7968aSToshiaki Makita 5348580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid) && skb->vlan_proto != br->vlan_proto) 5358580e211SToshiaki Makita *vid = 0; 5368580e211SToshiaki Makita 537e0d7968aSToshiaki Makita if (!*vid) { 53877751ee8SNikolay Aleksandrov *vid = br_get_pvid(vg); 5393df6bf45SVlad Yasevich if (!*vid) 540e0d7968aSToshiaki Makita return false; 541e0d7968aSToshiaki Makita 542e0d7968aSToshiaki Makita return true; 543e0d7968aSToshiaki Makita } 544e0d7968aSToshiaki Makita 54577751ee8SNikolay Aleksandrov if (br_vlan_find(vg, *vid)) 546e0d7968aSToshiaki Makita return true; 547e0d7968aSToshiaki Makita 548e0d7968aSToshiaki Makita return false; 549e0d7968aSToshiaki Makita } 550e0d7968aSToshiaki Makita 5518adff41cSToshiaki Makita /* Must be protected by RTNL. 5528adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 5538adff41cSToshiaki Makita */ 554552406c4SVlad Yasevich int br_vlan_add(struct net_bridge *br, u16 vid, u16 flags) 555243a2e63SVlad Yasevich { 556907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 5572594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 5582594e906SNikolay Aleksandrov int ret; 559243a2e63SVlad Yasevich 560243a2e63SVlad Yasevich ASSERT_RTNL(); 561243a2e63SVlad Yasevich 562907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 563907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(vg, vid); 5642594e906SNikolay Aleksandrov if (vlan) { 5652594e906SNikolay Aleksandrov if (!br_vlan_is_brentry(vlan)) { 5662594e906SNikolay Aleksandrov /* Trying to change flags of non-existent bridge vlan */ 5672594e906SNikolay Aleksandrov if (!(flags & BRIDGE_VLAN_INFO_BRENTRY)) 5682594e906SNikolay Aleksandrov return -EINVAL; 5692594e906SNikolay Aleksandrov /* It was only kept for port vlans, now make it real */ 5702594e906SNikolay Aleksandrov ret = br_fdb_insert(br, NULL, br->dev->dev_addr, 5712594e906SNikolay Aleksandrov vlan->vid); 5722594e906SNikolay Aleksandrov if (ret) { 5732594e906SNikolay Aleksandrov br_err(br, "failed insert local address into bridge forwarding table\n"); 5742594e906SNikolay Aleksandrov return ret; 5752594e906SNikolay Aleksandrov } 57625127759SReshetova, Elena refcount_inc(&vlan->refcnt); 5772594e906SNikolay Aleksandrov vlan->flags |= BRIDGE_VLAN_INFO_BRENTRY; 578907b1e6eSNikolay Aleksandrov vg->num_vlans++; 5792594e906SNikolay Aleksandrov } 5802594e906SNikolay Aleksandrov __vlan_add_flags(vlan, flags); 5812594e906SNikolay Aleksandrov return 0; 5822594e906SNikolay Aleksandrov } 583243a2e63SVlad Yasevich 5842594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 5852594e906SNikolay Aleksandrov if (!vlan) 586243a2e63SVlad Yasevich return -ENOMEM; 587243a2e63SVlad Yasevich 5886dada9b1SNikolay Aleksandrov vlan->stats = netdev_alloc_pcpu_stats(struct br_vlan_stats); 5896dada9b1SNikolay Aleksandrov if (!vlan->stats) { 5906dada9b1SNikolay Aleksandrov kfree(vlan); 5916dada9b1SNikolay Aleksandrov return -ENOMEM; 5926dada9b1SNikolay Aleksandrov } 5932594e906SNikolay Aleksandrov vlan->vid = vid; 5942594e906SNikolay Aleksandrov vlan->flags = flags | BRIDGE_VLAN_INFO_MASTER; 5952594e906SNikolay Aleksandrov vlan->flags &= ~BRIDGE_VLAN_INFO_PVID; 5962594e906SNikolay Aleksandrov vlan->br = br; 5972594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_BRENTRY) 59825127759SReshetova, Elena refcount_set(&vlan->refcnt, 1); 5992594e906SNikolay Aleksandrov ret = __vlan_add(vlan, flags); 6006dada9b1SNikolay Aleksandrov if (ret) { 6016dada9b1SNikolay Aleksandrov free_percpu(vlan->stats); 6022594e906SNikolay Aleksandrov kfree(vlan); 6036dada9b1SNikolay Aleksandrov } 604243a2e63SVlad Yasevich 6052594e906SNikolay Aleksandrov return ret; 606243a2e63SVlad Yasevich } 607243a2e63SVlad Yasevich 6088adff41cSToshiaki Makita /* Must be protected by RTNL. 6098adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 6108adff41cSToshiaki Makita */ 611243a2e63SVlad Yasevich int br_vlan_delete(struct net_bridge *br, u16 vid) 612243a2e63SVlad Yasevich { 613907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 6142594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 615243a2e63SVlad Yasevich 616243a2e63SVlad Yasevich ASSERT_RTNL(); 617243a2e63SVlad Yasevich 618907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 619907b1e6eSNikolay Aleksandrov v = br_vlan_find(vg, vid); 6202594e906SNikolay Aleksandrov if (!v || !br_vlan_is_brentry(v)) 6212594e906SNikolay Aleksandrov return -ENOENT; 622243a2e63SVlad Yasevich 623424bb9c9SToshiaki Makita br_fdb_find_delete_local(br, NULL, br->dev->dev_addr, vid); 6243741873bSRoopa Prabhu br_fdb_delete_by_port(br, NULL, vid, 0); 625bc9a25d2SVlad Yasevich 626efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 627efa5356bSRoopa Prabhu 6282594e906SNikolay Aleksandrov return __vlan_del(v); 629243a2e63SVlad Yasevich } 630243a2e63SVlad Yasevich 631243a2e63SVlad Yasevich void br_vlan_flush(struct net_bridge *br) 632243a2e63SVlad Yasevich { 633f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 634f409d0edSNikolay Aleksandrov 635243a2e63SVlad Yasevich ASSERT_RTNL(); 636243a2e63SVlad Yasevich 637f409d0edSNikolay Aleksandrov vg = br_vlan_group(br); 638f409d0edSNikolay Aleksandrov __vlan_flush(vg); 639f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(br->vlgrp, NULL); 640f409d0edSNikolay Aleksandrov synchronize_rcu(); 641f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 642243a2e63SVlad Yasevich } 643243a2e63SVlad Yasevich 6442594e906SNikolay Aleksandrov struct net_bridge_vlan *br_vlan_find(struct net_bridge_vlan_group *vg, u16 vid) 6452b292fb4SToshiaki Makita { 6462594e906SNikolay Aleksandrov if (!vg) 6472594e906SNikolay Aleksandrov return NULL; 6482b292fb4SToshiaki Makita 6492594e906SNikolay Aleksandrov return br_vlan_lookup(&vg->vlan_hash, vid); 6502b292fb4SToshiaki Makita } 6512b292fb4SToshiaki Makita 652204177f3SToshiaki Makita /* Must be protected by RTNL. */ 653204177f3SToshiaki Makita static void recalculate_group_addr(struct net_bridge *br) 654204177f3SToshiaki Makita { 655204177f3SToshiaki Makita if (br->group_addr_set) 656204177f3SToshiaki Makita return; 657204177f3SToshiaki Makita 658204177f3SToshiaki Makita spin_lock_bh(&br->lock); 659204177f3SToshiaki Makita if (!br->vlan_enabled || br->vlan_proto == htons(ETH_P_8021Q)) { 660204177f3SToshiaki Makita /* Bridge Group Address */ 661204177f3SToshiaki Makita br->group_addr[5] = 0x00; 662204177f3SToshiaki Makita } else { /* vlan_enabled && ETH_P_8021AD */ 663204177f3SToshiaki Makita /* Provider Bridge Group Address */ 664204177f3SToshiaki Makita br->group_addr[5] = 0x08; 665204177f3SToshiaki Makita } 666204177f3SToshiaki Makita spin_unlock_bh(&br->lock); 667204177f3SToshiaki Makita } 668204177f3SToshiaki Makita 669204177f3SToshiaki Makita /* Must be protected by RTNL. */ 670204177f3SToshiaki Makita void br_recalculate_fwd_mask(struct net_bridge *br) 671204177f3SToshiaki Makita { 672204177f3SToshiaki Makita if (!br->vlan_enabled || br->vlan_proto == htons(ETH_P_8021Q)) 673204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_DEFAULT; 674204177f3SToshiaki Makita else /* vlan_enabled && ETH_P_8021AD */ 675204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_8021AD & 676204177f3SToshiaki Makita ~(1u << br->group_addr[5]); 677204177f3SToshiaki Makita } 678204177f3SToshiaki Makita 679a7854037SNikolay Aleksandrov int __br_vlan_filter_toggle(struct net_bridge *br, unsigned long val) 680243a2e63SVlad Yasevich { 6816b72a770SElad Raz struct switchdev_attr attr = { 6826b72a770SElad Raz .orig_dev = br->dev, 6836b72a770SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 6846b72a770SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 6856b72a770SElad Raz .u.vlan_filtering = val, 6866b72a770SElad Raz }; 6876b72a770SElad Raz int err; 6886b72a770SElad Raz 689243a2e63SVlad Yasevich if (br->vlan_enabled == val) 690a7854037SNikolay Aleksandrov return 0; 691243a2e63SVlad Yasevich 6926b72a770SElad Raz err = switchdev_port_attr_set(br->dev, &attr); 6936b72a770SElad Raz if (err && err != -EOPNOTSUPP) 6946b72a770SElad Raz return err; 6956b72a770SElad Raz 696243a2e63SVlad Yasevich br->vlan_enabled = val; 6972796d0c6SVlad Yasevich br_manage_promisc(br); 698204177f3SToshiaki Makita recalculate_group_addr(br); 699204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 700243a2e63SVlad Yasevich 701a7854037SNikolay Aleksandrov return 0; 702a7854037SNikolay Aleksandrov } 703a7854037SNikolay Aleksandrov 704a7854037SNikolay Aleksandrov int br_vlan_filter_toggle(struct net_bridge *br, unsigned long val) 705a7854037SNikolay Aleksandrov { 706047831a9SXin Long return __br_vlan_filter_toggle(br, val); 707243a2e63SVlad Yasevich } 708243a2e63SVlad Yasevich 7091f51445aSIdo Schimmel bool br_vlan_enabled(const struct net_device *dev) 7101f51445aSIdo Schimmel { 7111f51445aSIdo Schimmel struct net_bridge *br = netdev_priv(dev); 7121f51445aSIdo Schimmel 7131f51445aSIdo Schimmel return !!br->vlan_enabled; 7141f51445aSIdo Schimmel } 7151f51445aSIdo Schimmel EXPORT_SYMBOL_GPL(br_vlan_enabled); 7161f51445aSIdo Schimmel 717d2d427b3SToshiaki Makita int __br_vlan_set_proto(struct net_bridge *br, __be16 proto) 718204177f3SToshiaki Makita { 719204177f3SToshiaki Makita int err = 0; 720204177f3SToshiaki Makita struct net_bridge_port *p; 7212594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 722907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 723d2d427b3SToshiaki Makita __be16 oldproto; 724204177f3SToshiaki Makita 725204177f3SToshiaki Makita if (br->vlan_proto == proto) 726d2d427b3SToshiaki Makita return 0; 727204177f3SToshiaki Makita 728204177f3SToshiaki Makita /* Add VLANs for the new proto to the device filter. */ 729204177f3SToshiaki Makita list_for_each_entry(p, &br->port_list, list) { 730907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 731907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 7322594e906SNikolay Aleksandrov err = vlan_vid_add(p->dev, proto, vlan->vid); 733204177f3SToshiaki Makita if (err) 734204177f3SToshiaki Makita goto err_filt; 735204177f3SToshiaki Makita } 736204177f3SToshiaki Makita } 737204177f3SToshiaki Makita 738204177f3SToshiaki Makita oldproto = br->vlan_proto; 739204177f3SToshiaki Makita br->vlan_proto = proto; 740204177f3SToshiaki Makita 741204177f3SToshiaki Makita recalculate_group_addr(br); 742204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 743204177f3SToshiaki Makita 744204177f3SToshiaki Makita /* Delete VLANs for the old proto from the device filter. */ 745907b1e6eSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 746907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 747907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 7482594e906SNikolay Aleksandrov vlan_vid_del(p->dev, oldproto, vlan->vid); 749907b1e6eSNikolay Aleksandrov } 750204177f3SToshiaki Makita 751d2d427b3SToshiaki Makita return 0; 752204177f3SToshiaki Makita 753204177f3SToshiaki Makita err_filt: 754907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(vlan, &vg->vlan_list, vlist) 7552594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 756204177f3SToshiaki Makita 757907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(p, &br->port_list, list) { 758907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 759907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 7602594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 761907b1e6eSNikolay Aleksandrov } 762204177f3SToshiaki Makita 763d2d427b3SToshiaki Makita return err; 764d2d427b3SToshiaki Makita } 765d2d427b3SToshiaki Makita 766d2d427b3SToshiaki Makita int br_vlan_set_proto(struct net_bridge *br, unsigned long val) 767d2d427b3SToshiaki Makita { 768d2d427b3SToshiaki Makita if (val != ETH_P_8021Q && val != ETH_P_8021AD) 769d2d427b3SToshiaki Makita return -EPROTONOSUPPORT; 770d2d427b3SToshiaki Makita 771047831a9SXin Long return __br_vlan_set_proto(br, htons(val)); 772204177f3SToshiaki Makita } 773204177f3SToshiaki Makita 7746dada9b1SNikolay Aleksandrov int br_vlan_set_stats(struct net_bridge *br, unsigned long val) 7756dada9b1SNikolay Aleksandrov { 7766dada9b1SNikolay Aleksandrov switch (val) { 7776dada9b1SNikolay Aleksandrov case 0: 7786dada9b1SNikolay Aleksandrov case 1: 7796dada9b1SNikolay Aleksandrov br->vlan_stats_enabled = val; 7806dada9b1SNikolay Aleksandrov break; 7816dada9b1SNikolay Aleksandrov default: 7826dada9b1SNikolay Aleksandrov return -EINVAL; 7836dada9b1SNikolay Aleksandrov } 7846dada9b1SNikolay Aleksandrov 7856dada9b1SNikolay Aleksandrov return 0; 7866dada9b1SNikolay Aleksandrov } 7876dada9b1SNikolay Aleksandrov 78877751ee8SNikolay Aleksandrov static bool vlan_default_pvid(struct net_bridge_vlan_group *vg, u16 vid) 7895be5a2dfSVlad Yasevich { 7902594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 7912594e906SNikolay Aleksandrov 79277751ee8SNikolay Aleksandrov if (vid != vg->pvid) 7932594e906SNikolay Aleksandrov return false; 7942594e906SNikolay Aleksandrov 7952594e906SNikolay Aleksandrov v = br_vlan_lookup(&vg->vlan_hash, vid); 7962594e906SNikolay Aleksandrov if (v && br_vlan_should_use(v) && 7972594e906SNikolay Aleksandrov (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) 7982594e906SNikolay Aleksandrov return true; 7992594e906SNikolay Aleksandrov 8002594e906SNikolay Aleksandrov return false; 8015be5a2dfSVlad Yasevich } 8025be5a2dfSVlad Yasevich 8035be5a2dfSVlad Yasevich static void br_vlan_disable_default_pvid(struct net_bridge *br) 8045be5a2dfSVlad Yasevich { 8055be5a2dfSVlad Yasevich struct net_bridge_port *p; 8065be5a2dfSVlad Yasevich u16 pvid = br->default_pvid; 8075be5a2dfSVlad Yasevich 8085be5a2dfSVlad Yasevich /* Disable default_pvid on all ports where it is still 8095be5a2dfSVlad Yasevich * configured. 8105be5a2dfSVlad Yasevich */ 811907b1e6eSNikolay Aleksandrov if (vlan_default_pvid(br_vlan_group(br), pvid)) 8125be5a2dfSVlad Yasevich br_vlan_delete(br, pvid); 8135be5a2dfSVlad Yasevich 8145be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 815907b1e6eSNikolay Aleksandrov if (vlan_default_pvid(nbp_vlan_group(p), pvid)) 8165be5a2dfSVlad Yasevich nbp_vlan_delete(p, pvid); 8175be5a2dfSVlad Yasevich } 8185be5a2dfSVlad Yasevich 8195be5a2dfSVlad Yasevich br->default_pvid = 0; 8205be5a2dfSVlad Yasevich } 8215be5a2dfSVlad Yasevich 8220f963b75SNikolay Aleksandrov int __br_vlan_set_default_pvid(struct net_bridge *br, u16 pvid) 8235be5a2dfSVlad Yasevich { 8242594e906SNikolay Aleksandrov const struct net_bridge_vlan *pvent; 825907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 8265be5a2dfSVlad Yasevich struct net_bridge_port *p; 8275be5a2dfSVlad Yasevich u16 old_pvid; 8285be5a2dfSVlad Yasevich int err = 0; 8295be5a2dfSVlad Yasevich unsigned long *changed; 8305be5a2dfSVlad Yasevich 8310f963b75SNikolay Aleksandrov if (!pvid) { 8320f963b75SNikolay Aleksandrov br_vlan_disable_default_pvid(br); 8330f963b75SNikolay Aleksandrov return 0; 8340f963b75SNikolay Aleksandrov } 8350f963b75SNikolay Aleksandrov 8365be5a2dfSVlad Yasevich changed = kcalloc(BITS_TO_LONGS(BR_MAX_PORTS), sizeof(unsigned long), 8375be5a2dfSVlad Yasevich GFP_KERNEL); 8385be5a2dfSVlad Yasevich if (!changed) 8395be5a2dfSVlad Yasevich return -ENOMEM; 8405be5a2dfSVlad Yasevich 8415be5a2dfSVlad Yasevich old_pvid = br->default_pvid; 8425be5a2dfSVlad Yasevich 8435be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 8445be5a2dfSVlad Yasevich * user configuration. 8455be5a2dfSVlad Yasevich */ 846907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 847907b1e6eSNikolay Aleksandrov pvent = br_vlan_find(vg, pvid); 848907b1e6eSNikolay Aleksandrov if ((!old_pvid || vlan_default_pvid(vg, old_pvid)) && 8492594e906SNikolay Aleksandrov (!pvent || !br_vlan_should_use(pvent))) { 8505be5a2dfSVlad Yasevich err = br_vlan_add(br, pvid, 8515be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 8522594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 8532594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY); 8545be5a2dfSVlad Yasevich if (err) 8555be5a2dfSVlad Yasevich goto out; 8565be5a2dfSVlad Yasevich br_vlan_delete(br, old_pvid); 8575be5a2dfSVlad Yasevich set_bit(0, changed); 8585be5a2dfSVlad Yasevich } 8595be5a2dfSVlad Yasevich 8605be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 8615be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 8625be5a2dfSVlad Yasevich * user configuration. 8635be5a2dfSVlad Yasevich */ 864907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 8655be5a2dfSVlad Yasevich if ((old_pvid && 866907b1e6eSNikolay Aleksandrov !vlan_default_pvid(vg, old_pvid)) || 867907b1e6eSNikolay Aleksandrov br_vlan_find(vg, pvid)) 8685be5a2dfSVlad Yasevich continue; 8695be5a2dfSVlad Yasevich 8705be5a2dfSVlad Yasevich err = nbp_vlan_add(p, pvid, 8715be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 8725be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_UNTAGGED); 8735be5a2dfSVlad Yasevich if (err) 8745be5a2dfSVlad Yasevich goto err_port; 8755be5a2dfSVlad Yasevich nbp_vlan_delete(p, old_pvid); 8765be5a2dfSVlad Yasevich set_bit(p->port_no, changed); 8775be5a2dfSVlad Yasevich } 8785be5a2dfSVlad Yasevich 8795be5a2dfSVlad Yasevich br->default_pvid = pvid; 8805be5a2dfSVlad Yasevich 8815be5a2dfSVlad Yasevich out: 8825be5a2dfSVlad Yasevich kfree(changed); 8835be5a2dfSVlad Yasevich return err; 8845be5a2dfSVlad Yasevich 8855be5a2dfSVlad Yasevich err_port: 8865be5a2dfSVlad Yasevich list_for_each_entry_continue_reverse(p, &br->port_list, list) { 8875be5a2dfSVlad Yasevich if (!test_bit(p->port_no, changed)) 8885be5a2dfSVlad Yasevich continue; 8895be5a2dfSVlad Yasevich 8905be5a2dfSVlad Yasevich if (old_pvid) 8915be5a2dfSVlad Yasevich nbp_vlan_add(p, old_pvid, 8925be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 8935be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_UNTAGGED); 8945be5a2dfSVlad Yasevich nbp_vlan_delete(p, pvid); 8955be5a2dfSVlad Yasevich } 8965be5a2dfSVlad Yasevich 8975be5a2dfSVlad Yasevich if (test_bit(0, changed)) { 8985be5a2dfSVlad Yasevich if (old_pvid) 8995be5a2dfSVlad Yasevich br_vlan_add(br, old_pvid, 9005be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 9012594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 9022594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY); 9035be5a2dfSVlad Yasevich br_vlan_delete(br, pvid); 9045be5a2dfSVlad Yasevich } 9055be5a2dfSVlad Yasevich goto out; 9065be5a2dfSVlad Yasevich } 9075be5a2dfSVlad Yasevich 90896a20d9dSVlad Yasevich int br_vlan_set_default_pvid(struct net_bridge *br, unsigned long val) 90996a20d9dSVlad Yasevich { 91096a20d9dSVlad Yasevich u16 pvid = val; 91196a20d9dSVlad Yasevich int err = 0; 91296a20d9dSVlad Yasevich 9135be5a2dfSVlad Yasevich if (val >= VLAN_VID_MASK) 91496a20d9dSVlad Yasevich return -EINVAL; 91596a20d9dSVlad Yasevich 91696a20d9dSVlad Yasevich if (pvid == br->default_pvid) 917047831a9SXin Long goto out; 91896a20d9dSVlad Yasevich 91996a20d9dSVlad Yasevich /* Only allow default pvid change when filtering is disabled */ 92096a20d9dSVlad Yasevich if (br->vlan_enabled) { 92196a20d9dSVlad Yasevich pr_info_once("Please disable vlan filtering to change default_pvid\n"); 92296a20d9dSVlad Yasevich err = -EPERM; 923047831a9SXin Long goto out; 92496a20d9dSVlad Yasevich } 9255be5a2dfSVlad Yasevich err = __br_vlan_set_default_pvid(br, pvid); 926047831a9SXin Long out: 92796a20d9dSVlad Yasevich return err; 92896a20d9dSVlad Yasevich } 92996a20d9dSVlad Yasevich 9305be5a2dfSVlad Yasevich int br_vlan_init(struct net_bridge *br) 9318580e211SToshiaki Makita { 932907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 9332594e906SNikolay Aleksandrov int ret = -ENOMEM; 9342594e906SNikolay Aleksandrov 935907b1e6eSNikolay Aleksandrov vg = kzalloc(sizeof(*vg), GFP_KERNEL); 936907b1e6eSNikolay Aleksandrov if (!vg) 9372594e906SNikolay Aleksandrov goto out; 938907b1e6eSNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 9392594e906SNikolay Aleksandrov if (ret) 9402594e906SNikolay Aleksandrov goto err_rhtbl; 941efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 942efa5356bSRoopa Prabhu if (ret) 943efa5356bSRoopa Prabhu goto err_tunnel_init; 944907b1e6eSNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 9458580e211SToshiaki Makita br->vlan_proto = htons(ETH_P_8021Q); 94696a20d9dSVlad Yasevich br->default_pvid = 1; 947907b1e6eSNikolay Aleksandrov rcu_assign_pointer(br->vlgrp, vg); 9482594e906SNikolay Aleksandrov ret = br_vlan_add(br, 1, 9492594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | BRIDGE_VLAN_INFO_UNTAGGED | 9502594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY); 9512594e906SNikolay Aleksandrov if (ret) 9522594e906SNikolay Aleksandrov goto err_vlan_add; 9532594e906SNikolay Aleksandrov 9542594e906SNikolay Aleksandrov out: 9552594e906SNikolay Aleksandrov return ret; 9562594e906SNikolay Aleksandrov 9572594e906SNikolay Aleksandrov err_vlan_add: 958efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 959efa5356bSRoopa Prabhu err_tunnel_init: 960907b1e6eSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 9612594e906SNikolay Aleksandrov err_rhtbl: 962907b1e6eSNikolay Aleksandrov kfree(vg); 9632594e906SNikolay Aleksandrov 9642594e906SNikolay Aleksandrov goto out; 9652594e906SNikolay Aleksandrov } 9662594e906SNikolay Aleksandrov 9672594e906SNikolay Aleksandrov int nbp_vlan_init(struct net_bridge_port *p) 9682594e906SNikolay Aleksandrov { 969404cdbf0SElad Raz struct switchdev_attr attr = { 970404cdbf0SElad Raz .orig_dev = p->br->dev, 971404cdbf0SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 972404cdbf0SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 973404cdbf0SElad Raz .u.vlan_filtering = p->br->vlan_enabled, 974404cdbf0SElad Raz }; 975263344e6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 9762594e906SNikolay Aleksandrov int ret = -ENOMEM; 9772594e906SNikolay Aleksandrov 978263344e6SNikolay Aleksandrov vg = kzalloc(sizeof(struct net_bridge_vlan_group), GFP_KERNEL); 979263344e6SNikolay Aleksandrov if (!vg) 9802594e906SNikolay Aleksandrov goto out; 9812594e906SNikolay Aleksandrov 982404cdbf0SElad Raz ret = switchdev_port_attr_set(p->dev, &attr); 983404cdbf0SElad Raz if (ret && ret != -EOPNOTSUPP) 984404cdbf0SElad Raz goto err_vlan_enabled; 985404cdbf0SElad Raz 986263344e6SNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 9872594e906SNikolay Aleksandrov if (ret) 9882594e906SNikolay Aleksandrov goto err_rhtbl; 989efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 990efa5356bSRoopa Prabhu if (ret) 991efa5356bSRoopa Prabhu goto err_tunnel_init; 992263344e6SNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 993907b1e6eSNikolay Aleksandrov rcu_assign_pointer(p->vlgrp, vg); 9942594e906SNikolay Aleksandrov if (p->br->default_pvid) { 9952594e906SNikolay Aleksandrov ret = nbp_vlan_add(p, p->br->default_pvid, 9962594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | 9972594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED); 9982594e906SNikolay Aleksandrov if (ret) 9992594e906SNikolay Aleksandrov goto err_vlan_add; 10002594e906SNikolay Aleksandrov } 10012594e906SNikolay Aleksandrov out: 10022594e906SNikolay Aleksandrov return ret; 10032594e906SNikolay Aleksandrov 10042594e906SNikolay Aleksandrov err_vlan_add: 100507bc588fSIdo Schimmel RCU_INIT_POINTER(p->vlgrp, NULL); 100607bc588fSIdo Schimmel synchronize_rcu(); 1007efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 1008efa5356bSRoopa Prabhu err_tunnel_init: 1009efa5356bSRoopa Prabhu rhashtable_destroy(&vg->vlan_hash); 10102594e906SNikolay Aleksandrov err_rhtbl: 1011df2c4334SYotam Gigi err_vlan_enabled: 1012263344e6SNikolay Aleksandrov kfree(vg); 10132594e906SNikolay Aleksandrov 10142594e906SNikolay Aleksandrov goto out; 10158580e211SToshiaki Makita } 10168580e211SToshiaki Makita 10178adff41cSToshiaki Makita /* Must be protected by RTNL. 10188adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 10198adff41cSToshiaki Makita */ 1020552406c4SVlad Yasevich int nbp_vlan_add(struct net_bridge_port *port, u16 vid, u16 flags) 1021243a2e63SVlad Yasevich { 10227fbac984SIdo Schimmel struct switchdev_obj_port_vlan v = { 10237fbac984SIdo Schimmel .obj.orig_dev = port->dev, 10247fbac984SIdo Schimmel .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN, 10257fbac984SIdo Schimmel .flags = flags, 10267fbac984SIdo Schimmel .vid_begin = vid, 10277fbac984SIdo Schimmel .vid_end = vid, 10287fbac984SIdo Schimmel }; 10292594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 10302594e906SNikolay Aleksandrov int ret; 1031243a2e63SVlad Yasevich 1032243a2e63SVlad Yasevich ASSERT_RTNL(); 1033243a2e63SVlad Yasevich 1034907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group(port), vid); 10352594e906SNikolay Aleksandrov if (vlan) { 10367fbac984SIdo Schimmel /* Pass the flags to the hardware bridge */ 10377fbac984SIdo Schimmel ret = switchdev_port_obj_add(port->dev, &v.obj); 10387fbac984SIdo Schimmel if (ret && ret != -EOPNOTSUPP) 10397fbac984SIdo Schimmel return ret; 10402594e906SNikolay Aleksandrov __vlan_add_flags(vlan, flags); 10412594e906SNikolay Aleksandrov return 0; 1042243a2e63SVlad Yasevich } 1043243a2e63SVlad Yasevich 10442594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 10452594e906SNikolay Aleksandrov if (!vlan) 10462594e906SNikolay Aleksandrov return -ENOMEM; 1047243a2e63SVlad Yasevich 10482594e906SNikolay Aleksandrov vlan->vid = vid; 10492594e906SNikolay Aleksandrov vlan->port = port; 10502594e906SNikolay Aleksandrov ret = __vlan_add(vlan, flags); 10512594e906SNikolay Aleksandrov if (ret) 10522594e906SNikolay Aleksandrov kfree(vlan); 1053243a2e63SVlad Yasevich 10542594e906SNikolay Aleksandrov return ret; 1055243a2e63SVlad Yasevich } 1056243a2e63SVlad Yasevich 10578adff41cSToshiaki Makita /* Must be protected by RTNL. 10588adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 10598adff41cSToshiaki Makita */ 1060243a2e63SVlad Yasevich int nbp_vlan_delete(struct net_bridge_port *port, u16 vid) 1061243a2e63SVlad Yasevich { 10622594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 1063243a2e63SVlad Yasevich 1064243a2e63SVlad Yasevich ASSERT_RTNL(); 1065243a2e63SVlad Yasevich 1066907b1e6eSNikolay Aleksandrov v = br_vlan_find(nbp_vlan_group(port), vid); 10672594e906SNikolay Aleksandrov if (!v) 10682594e906SNikolay Aleksandrov return -ENOENT; 1069424bb9c9SToshiaki Makita br_fdb_find_delete_local(port->br, port, port->dev->dev_addr, vid); 10701ea2d020SNikolay Aleksandrov br_fdb_delete_by_port(port->br, port, vid, 0); 1071bc9a25d2SVlad Yasevich 10722594e906SNikolay Aleksandrov return __vlan_del(v); 1073243a2e63SVlad Yasevich } 1074243a2e63SVlad Yasevich 1075243a2e63SVlad Yasevich void nbp_vlan_flush(struct net_bridge_port *port) 1076243a2e63SVlad Yasevich { 1077f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 1078f409d0edSNikolay Aleksandrov 1079243a2e63SVlad Yasevich ASSERT_RTNL(); 1080243a2e63SVlad Yasevich 1081f409d0edSNikolay Aleksandrov vg = nbp_vlan_group(port); 1082f409d0edSNikolay Aleksandrov __vlan_flush(vg); 1083f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(port->vlgrp, NULL); 1084f409d0edSNikolay Aleksandrov synchronize_rcu(); 1085f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 10865be5a2dfSVlad Yasevich } 1087a60c0903SNikolay Aleksandrov 1088a60c0903SNikolay Aleksandrov void br_vlan_get_stats(const struct net_bridge_vlan *v, 1089a60c0903SNikolay Aleksandrov struct br_vlan_stats *stats) 1090a60c0903SNikolay Aleksandrov { 1091a60c0903SNikolay Aleksandrov int i; 1092a60c0903SNikolay Aleksandrov 1093a60c0903SNikolay Aleksandrov memset(stats, 0, sizeof(*stats)); 1094a60c0903SNikolay Aleksandrov for_each_possible_cpu(i) { 1095a60c0903SNikolay Aleksandrov u64 rxpackets, rxbytes, txpackets, txbytes; 1096a60c0903SNikolay Aleksandrov struct br_vlan_stats *cpu_stats; 1097a60c0903SNikolay Aleksandrov unsigned int start; 1098a60c0903SNikolay Aleksandrov 1099a60c0903SNikolay Aleksandrov cpu_stats = per_cpu_ptr(v->stats, i); 1100a60c0903SNikolay Aleksandrov do { 1101a60c0903SNikolay Aleksandrov start = u64_stats_fetch_begin_irq(&cpu_stats->syncp); 1102a60c0903SNikolay Aleksandrov rxpackets = cpu_stats->rx_packets; 1103a60c0903SNikolay Aleksandrov rxbytes = cpu_stats->rx_bytes; 1104a60c0903SNikolay Aleksandrov txbytes = cpu_stats->tx_bytes; 1105a60c0903SNikolay Aleksandrov txpackets = cpu_stats->tx_packets; 1106a60c0903SNikolay Aleksandrov } while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start)); 1107a60c0903SNikolay Aleksandrov 1108a60c0903SNikolay Aleksandrov stats->rx_packets += rxpackets; 1109a60c0903SNikolay Aleksandrov stats->rx_bytes += rxbytes; 1110a60c0903SNikolay Aleksandrov stats->tx_bytes += txbytes; 1111a60c0903SNikolay Aleksandrov stats->tx_packets += txpackets; 1112a60c0903SNikolay Aleksandrov } 1113a60c0903SNikolay Aleksandrov } 1114