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 35f418af63SNikolay Aleksandrov static bool __vlan_add_pvid(struct net_bridge_vlan_group *vg, u16 vid) 362594e906SNikolay Aleksandrov { 3777751ee8SNikolay Aleksandrov if (vg->pvid == vid) 38f418af63SNikolay Aleksandrov return false; 39552406c4SVlad Yasevich 40552406c4SVlad Yasevich smp_wmb(); 4177751ee8SNikolay Aleksandrov vg->pvid = vid; 42f418af63SNikolay Aleksandrov 43f418af63SNikolay Aleksandrov return true; 44552406c4SVlad Yasevich } 45552406c4SVlad Yasevich 46f418af63SNikolay Aleksandrov static bool __vlan_delete_pvid(struct net_bridge_vlan_group *vg, u16 vid) 47552406c4SVlad Yasevich { 4877751ee8SNikolay Aleksandrov if (vg->pvid != vid) 49f418af63SNikolay Aleksandrov return false; 50552406c4SVlad Yasevich 51552406c4SVlad Yasevich smp_wmb(); 5277751ee8SNikolay Aleksandrov vg->pvid = 0; 53f418af63SNikolay Aleksandrov 54f418af63SNikolay Aleksandrov return true; 55552406c4SVlad Yasevich } 56552406c4SVlad Yasevich 57f418af63SNikolay Aleksandrov /* return true if anything changed, false otherwise */ 58f418af63SNikolay Aleksandrov static bool __vlan_add_flags(struct net_bridge_vlan *v, u16 flags) 5935e03f3aSVlad Yasevich { 6077751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 61f418af63SNikolay Aleksandrov u16 old_flags = v->flags; 62f418af63SNikolay Aleksandrov bool ret; 6377751ee8SNikolay Aleksandrov 642594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) 65907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 66635126b7SVlad Yasevich else 67907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 6877751ee8SNikolay Aleksandrov 6977751ee8SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_PVID) 70f418af63SNikolay Aleksandrov ret = __vlan_add_pvid(vg, v->vid); 712594e906SNikolay Aleksandrov else 72f418af63SNikolay Aleksandrov ret = __vlan_delete_pvid(vg, v->vid); 7335e03f3aSVlad Yasevich 7435e03f3aSVlad Yasevich if (flags & BRIDGE_VLAN_INFO_UNTAGGED) 752594e906SNikolay Aleksandrov v->flags |= BRIDGE_VLAN_INFO_UNTAGGED; 76635126b7SVlad Yasevich else 772594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_UNTAGGED; 78f418af63SNikolay Aleksandrov 79f418af63SNikolay Aleksandrov return ret || !!(old_flags ^ v->flags); 8035e03f3aSVlad Yasevich } 8135e03f3aSVlad Yasevich 827f109539SScott Feldman static int __vlan_vid_add(struct net_device *dev, struct net_bridge *br, 837f109539SScott Feldman u16 vid, u16 flags) 847f109539SScott Feldman { 850944d6b5SJiri Pirko int err; 867f109539SScott Feldman 870944d6b5SJiri Pirko /* Try switchdev op first. In case it is not supported, fallback to 880944d6b5SJiri Pirko * 8021q add. 890944d6b5SJiri Pirko */ 90d66e4348SPetr Machata err = br_switchdev_port_vlan_add(dev, vid, flags); 917f109539SScott Feldman if (err == -EOPNOTSUPP) 920944d6b5SJiri Pirko return vlan_vid_add(dev, br->vlan_proto, vid); 937f109539SScott Feldman return err; 947f109539SScott Feldman } 957f109539SScott Feldman 962594e906SNikolay Aleksandrov static void __vlan_add_list(struct net_bridge_vlan *v) 97243a2e63SVlad Yasevich { 98907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 992594e906SNikolay Aleksandrov struct list_head *headp, *hpos; 1002594e906SNikolay Aleksandrov struct net_bridge_vlan *vent; 101243a2e63SVlad Yasevich 102907b1e6eSNikolay Aleksandrov if (br_vlan_is_master(v)) 103907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 104907b1e6eSNikolay Aleksandrov else 105907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 106907b1e6eSNikolay Aleksandrov 107907b1e6eSNikolay Aleksandrov headp = &vg->vlan_list; 1082594e906SNikolay Aleksandrov list_for_each_prev(hpos, headp) { 1092594e906SNikolay Aleksandrov vent = list_entry(hpos, struct net_bridge_vlan, vlist); 1102594e906SNikolay Aleksandrov if (v->vid < vent->vid) 1112594e906SNikolay Aleksandrov continue; 1122594e906SNikolay Aleksandrov else 1132594e906SNikolay Aleksandrov break; 1142594e906SNikolay Aleksandrov } 115586c2b57SNikolay Aleksandrov list_add_rcu(&v->vlist, hpos); 116552406c4SVlad Yasevich } 117243a2e63SVlad Yasevich 1182594e906SNikolay Aleksandrov static void __vlan_del_list(struct net_bridge_vlan *v) 1192594e906SNikolay Aleksandrov { 120586c2b57SNikolay Aleksandrov list_del_rcu(&v->vlist); 121243a2e63SVlad Yasevich } 122243a2e63SVlad Yasevich 123bf361ad3SVivien Didelot static int __vlan_vid_del(struct net_device *dev, struct net_bridge *br, 1247f109539SScott Feldman u16 vid) 1257f109539SScott Feldman { 1260944d6b5SJiri Pirko int err; 1277f109539SScott Feldman 1280944d6b5SJiri Pirko /* Try switchdev op first. In case it is not supported, fallback to 1290944d6b5SJiri Pirko * 8021q del. 1300944d6b5SJiri Pirko */ 131d66e4348SPetr Machata err = br_switchdev_port_vlan_del(dev, vid); 1320944d6b5SJiri Pirko if (err == -EOPNOTSUPP) { 1330944d6b5SJiri Pirko vlan_vid_del(dev, br->vlan_proto, vid); 1340944d6b5SJiri Pirko return 0; 1357f109539SScott Feldman } 136bf361ad3SVivien Didelot return err; 1377f109539SScott Feldman } 1387f109539SScott Feldman 139f8ed289fSNikolay Aleksandrov /* Returns a master vlan, if it didn't exist it gets created. In all cases a 140f8ed289fSNikolay Aleksandrov * a reference is taken to the master vlan before returning. 141f8ed289fSNikolay Aleksandrov */ 142f8ed289fSNikolay Aleksandrov static struct net_bridge_vlan *br_vlan_get_master(struct net_bridge *br, u16 vid) 143f8ed289fSNikolay Aleksandrov { 144907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 145f8ed289fSNikolay Aleksandrov struct net_bridge_vlan *masterv; 146f8ed289fSNikolay Aleksandrov 147907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 148907b1e6eSNikolay Aleksandrov masterv = br_vlan_find(vg, vid); 149f8ed289fSNikolay Aleksandrov if (!masterv) { 150f418af63SNikolay Aleksandrov bool changed; 151f418af63SNikolay Aleksandrov 152f8ed289fSNikolay Aleksandrov /* missing global ctx, create it now */ 153f418af63SNikolay Aleksandrov if (br_vlan_add(br, vid, 0, &changed)) 154f8ed289fSNikolay Aleksandrov return NULL; 155907b1e6eSNikolay Aleksandrov masterv = br_vlan_find(vg, vid); 156f8ed289fSNikolay Aleksandrov if (WARN_ON(!masterv)) 157f8ed289fSNikolay Aleksandrov return NULL; 1580e5a82efSIdo Schimmel refcount_set(&masterv->refcnt, 1); 1590e5a82efSIdo Schimmel return masterv; 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 1939163a0fcSNikolay Aleksandrov static void nbp_vlan_rcu_free(struct rcu_head *rcu) 1949163a0fcSNikolay Aleksandrov { 1959163a0fcSNikolay Aleksandrov struct net_bridge_vlan *v; 1969163a0fcSNikolay Aleksandrov 1979163a0fcSNikolay Aleksandrov v = container_of(rcu, struct net_bridge_vlan, rcu); 1989163a0fcSNikolay Aleksandrov WARN_ON(br_vlan_is_master(v)); 1999163a0fcSNikolay Aleksandrov /* if we had per-port stats configured then free them here */ 2009163a0fcSNikolay Aleksandrov if (v->brvlan->stats != v->stats) 2019163a0fcSNikolay Aleksandrov free_percpu(v->stats); 2029163a0fcSNikolay Aleksandrov v->stats = NULL; 2039163a0fcSNikolay Aleksandrov kfree(v); 2049163a0fcSNikolay Aleksandrov } 2059163a0fcSNikolay Aleksandrov 2062594e906SNikolay Aleksandrov /* This is the shared VLAN add function which works for both ports and bridge 2072594e906SNikolay Aleksandrov * devices. There are four possible calls to this function in terms of the 2082594e906SNikolay Aleksandrov * vlan entry type: 2092594e906SNikolay Aleksandrov * 1. vlan is being added on a port (no master flags, global entry exists) 210ddd611d3SIdo Schimmel * 2. vlan is being added on a bridge (both master and brentry flags) 2112594e906SNikolay Aleksandrov * 3. vlan is being added on a port, but a global entry didn't exist which 212ddd611d3SIdo Schimmel * is being created right now (master flag set, brentry flag unset), the 2132594e906SNikolay Aleksandrov * global entry is used for global per-vlan features, but not for filtering 214ddd611d3SIdo Schimmel * 4. same as 3 but with both master and brentry flags set so the entry 2152594e906SNikolay Aleksandrov * will be used for filtering in both the port and the bridge 2162594e906SNikolay Aleksandrov */ 2172594e906SNikolay Aleksandrov static int __vlan_add(struct net_bridge_vlan *v, u16 flags) 218243a2e63SVlad Yasevich { 2192594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = NULL; 2202594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 2216be144f6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 2222594e906SNikolay Aleksandrov struct net_device *dev; 2232594e906SNikolay Aleksandrov struct net_bridge *br; 224bf361ad3SVivien Didelot int err; 225bf361ad3SVivien Didelot 2262594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 2272594e906SNikolay Aleksandrov br = v->br; 2282594e906SNikolay Aleksandrov dev = br->dev; 229907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 2302594e906SNikolay Aleksandrov } else { 2312594e906SNikolay Aleksandrov p = v->port; 2322594e906SNikolay Aleksandrov br = p->br; 2332594e906SNikolay Aleksandrov dev = p->dev; 234907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 2352594e906SNikolay Aleksandrov } 2362594e906SNikolay Aleksandrov 2372594e906SNikolay Aleksandrov if (p) { 2382594e906SNikolay Aleksandrov /* Add VLAN to the device filter if it is supported. 2392594e906SNikolay Aleksandrov * This ensures tagged traffic enters the bridge when 2402594e906SNikolay Aleksandrov * promiscuous mode is disabled by br_manage_promisc(). 2412594e906SNikolay Aleksandrov */ 2422594e906SNikolay Aleksandrov err = __vlan_vid_add(dev, br, v->vid, flags); 243bf361ad3SVivien Didelot if (err) 2442594e906SNikolay Aleksandrov goto out; 2452594e906SNikolay Aleksandrov 2462594e906SNikolay Aleksandrov /* need to work on the master vlan too */ 2472594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_MASTER) { 248f418af63SNikolay Aleksandrov bool changed; 249f418af63SNikolay Aleksandrov 250f418af63SNikolay Aleksandrov err = br_vlan_add(br, v->vid, 251f418af63SNikolay Aleksandrov flags | BRIDGE_VLAN_INFO_BRENTRY, 252f418af63SNikolay Aleksandrov &changed); 2532594e906SNikolay Aleksandrov if (err) 2542594e906SNikolay Aleksandrov goto out_filt; 2552594e906SNikolay Aleksandrov } 2562594e906SNikolay Aleksandrov 257f8ed289fSNikolay Aleksandrov masterv = br_vlan_get_master(br, v->vid); 258f8ed289fSNikolay Aleksandrov if (!masterv) 2592594e906SNikolay Aleksandrov goto out_filt; 2602594e906SNikolay Aleksandrov v->brvlan = masterv; 2619163a0fcSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_PER_PORT)) { 2629163a0fcSNikolay Aleksandrov v->stats = netdev_alloc_pcpu_stats(struct br_vlan_stats); 2639163a0fcSNikolay Aleksandrov if (!v->stats) { 2649163a0fcSNikolay Aleksandrov err = -ENOMEM; 2659163a0fcSNikolay Aleksandrov goto out_filt; 2669163a0fcSNikolay Aleksandrov } 2679163a0fcSNikolay Aleksandrov } else { 2686dada9b1SNikolay Aleksandrov v->stats = masterv->stats; 2699163a0fcSNikolay Aleksandrov } 2709c86ce2cSPetr Machata } else { 2719c86ce2cSPetr Machata err = br_switchdev_port_vlan_add(dev, v->vid, flags); 2729c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 2739c86ce2cSPetr Machata goto out; 2742594e906SNikolay Aleksandrov } 2752594e906SNikolay Aleksandrov 2766be144f6SNikolay Aleksandrov /* Add the dev mac and count the vlan only if it's usable */ 2772594e906SNikolay Aleksandrov if (br_vlan_should_use(v)) { 2782594e906SNikolay Aleksandrov err = br_fdb_insert(br, p, dev->dev_addr, v->vid); 2792594e906SNikolay Aleksandrov if (err) { 2802594e906SNikolay Aleksandrov br_err(br, "failed insert local address into bridge forwarding table\n"); 2812594e906SNikolay Aleksandrov goto out_filt; 2822594e906SNikolay Aleksandrov } 2836be144f6SNikolay Aleksandrov vg->num_vlans++; 2842594e906SNikolay Aleksandrov } 2852594e906SNikolay Aleksandrov 2866be144f6SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&vg->vlan_hash, &v->vnode, 2876be144f6SNikolay Aleksandrov br_vlan_rht_params); 2882594e906SNikolay Aleksandrov if (err) 2892594e906SNikolay Aleksandrov goto out_fdb_insert; 2902594e906SNikolay Aleksandrov 2912594e906SNikolay Aleksandrov __vlan_add_list(v); 2922594e906SNikolay Aleksandrov __vlan_add_flags(v, flags); 2932594e906SNikolay Aleksandrov out: 2942594e906SNikolay Aleksandrov return err; 2952594e906SNikolay Aleksandrov 2962594e906SNikolay Aleksandrov out_fdb_insert: 2976be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 2986be144f6SNikolay Aleksandrov br_fdb_find_delete_local(br, p, dev->dev_addr, v->vid); 2996be144f6SNikolay Aleksandrov vg->num_vlans--; 3006be144f6SNikolay Aleksandrov } 3012594e906SNikolay Aleksandrov 3022594e906SNikolay Aleksandrov out_filt: 3032594e906SNikolay Aleksandrov if (p) { 3042594e906SNikolay Aleksandrov __vlan_vid_del(dev, br, v->vid); 3052594e906SNikolay Aleksandrov if (masterv) { 306f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 3072594e906SNikolay Aleksandrov v->brvlan = NULL; 3082594e906SNikolay Aleksandrov } 3099c86ce2cSPetr Machata } else { 3109c86ce2cSPetr Machata br_switchdev_port_vlan_del(dev, v->vid); 3112594e906SNikolay Aleksandrov } 3122594e906SNikolay Aleksandrov 3132594e906SNikolay Aleksandrov goto out; 3142594e906SNikolay Aleksandrov } 3152594e906SNikolay Aleksandrov 3162594e906SNikolay Aleksandrov static int __vlan_del(struct net_bridge_vlan *v) 3172594e906SNikolay Aleksandrov { 3182594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = v; 31977751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 3202594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 3212594e906SNikolay Aleksandrov int err = 0; 3222594e906SNikolay Aleksandrov 3232594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 324907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 3252594e906SNikolay Aleksandrov } else { 3262594e906SNikolay Aleksandrov p = v->port; 327907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 3282594e906SNikolay Aleksandrov masterv = v->brvlan; 3292594e906SNikolay Aleksandrov } 3302594e906SNikolay Aleksandrov 33177751ee8SNikolay Aleksandrov __vlan_delete_pvid(vg, v->vid); 3322594e906SNikolay Aleksandrov if (p) { 3332594e906SNikolay Aleksandrov err = __vlan_vid_del(p->dev, p->br, v->vid); 3342594e906SNikolay Aleksandrov if (err) 3352594e906SNikolay Aleksandrov goto out; 3369c86ce2cSPetr Machata } else { 3379c86ce2cSPetr Machata err = br_switchdev_port_vlan_del(v->br->dev, v->vid); 3389c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 3399c86ce2cSPetr Machata goto out; 3409c86ce2cSPetr Machata err = 0; 3412594e906SNikolay Aleksandrov } 3422594e906SNikolay Aleksandrov 3436be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 3442594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_BRENTRY; 3456be144f6SNikolay Aleksandrov vg->num_vlans--; 3462594e906SNikolay Aleksandrov } 3472594e906SNikolay Aleksandrov 3482594e906SNikolay Aleksandrov if (masterv != v) { 349efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 35077751ee8SNikolay Aleksandrov rhashtable_remove_fast(&vg->vlan_hash, &v->vnode, 35177751ee8SNikolay Aleksandrov br_vlan_rht_params); 3522594e906SNikolay Aleksandrov __vlan_del_list(v); 3539163a0fcSNikolay Aleksandrov call_rcu(&v->rcu, nbp_vlan_rcu_free); 3542594e906SNikolay Aleksandrov } 3552594e906SNikolay Aleksandrov 356f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 3572594e906SNikolay Aleksandrov out: 358bf361ad3SVivien Didelot return err; 3598580e211SToshiaki Makita } 360243a2e63SVlad Yasevich 361f409d0edSNikolay Aleksandrov static void __vlan_group_free(struct net_bridge_vlan_group *vg) 362f409d0edSNikolay Aleksandrov { 363f409d0edSNikolay Aleksandrov WARN_ON(!list_empty(&vg->vlan_list)); 364f409d0edSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 365efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 366f409d0edSNikolay Aleksandrov kfree(vg); 367f409d0edSNikolay Aleksandrov } 368f409d0edSNikolay Aleksandrov 369f409d0edSNikolay Aleksandrov static void __vlan_flush(struct net_bridge_vlan_group *vg) 370243a2e63SVlad Yasevich { 3712594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan, *tmp; 3722594e906SNikolay Aleksandrov 373f409d0edSNikolay Aleksandrov __vlan_delete_pvid(vg, vg->pvid); 374f409d0edSNikolay Aleksandrov list_for_each_entry_safe(vlan, tmp, &vg->vlan_list, vlist) 3752594e906SNikolay Aleksandrov __vlan_del(vlan); 376243a2e63SVlad Yasevich } 377243a2e63SVlad Yasevich 37878851988SVlad Yasevich struct sk_buff *br_handle_vlan(struct net_bridge *br, 37911538d03SRoopa Prabhu const struct net_bridge_port *p, 3802594e906SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 381a37b85c9SVlad Yasevich struct sk_buff *skb) 382a37b85c9SVlad Yasevich { 3836dada9b1SNikolay Aleksandrov struct br_vlan_stats *stats; 3842594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 385a37b85c9SVlad Yasevich u16 vid; 386a37b85c9SVlad Yasevich 38720adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 38820adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 38978851988SVlad Yasevich goto out; 39078851988SVlad Yasevich 3912594e906SNikolay Aleksandrov /* At this point, we know that the frame was filtered and contains 3922594e906SNikolay Aleksandrov * a valid vlan id. If the vlan id has untagged flag set, 3932594e906SNikolay Aleksandrov * send untagged; otherwise, send tagged. 3942594e906SNikolay Aleksandrov */ 3952594e906SNikolay Aleksandrov br_vlan_get_tag(skb, &vid); 3962594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 3972594e906SNikolay Aleksandrov /* Vlan entry must be configured at this point. The 398fc92f745SVlad Yasevich * only exception is the bridge is set in promisc mode and the 399fc92f745SVlad Yasevich * packet is destined for the bridge device. In this case 400fc92f745SVlad Yasevich * pass the packet as is. 401fc92f745SVlad Yasevich */ 4022594e906SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) { 403fc92f745SVlad Yasevich if ((br->dev->flags & IFF_PROMISC) && skb->dev == br->dev) { 404fc92f745SVlad Yasevich goto out; 405fc92f745SVlad Yasevich } else { 406fc92f745SVlad Yasevich kfree_skb(skb); 407fc92f745SVlad Yasevich return NULL; 408fc92f745SVlad Yasevich } 409fc92f745SVlad Yasevich } 410ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { 4116dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 4126dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 4136dada9b1SNikolay Aleksandrov stats->tx_bytes += skb->len; 4146dada9b1SNikolay Aleksandrov stats->tx_packets++; 4156dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 4166dada9b1SNikolay Aleksandrov } 4176dada9b1SNikolay Aleksandrov 4182594e906SNikolay Aleksandrov if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED) 41999b192daSToshiaki Makita skb->vlan_tci = 0; 42011538d03SRoopa Prabhu 42111538d03SRoopa Prabhu if (p && (p->flags & BR_VLAN_TUNNEL) && 42211538d03SRoopa Prabhu br_handle_egress_vlan_tunnel(skb, v)) { 42311538d03SRoopa Prabhu kfree_skb(skb); 42411538d03SRoopa Prabhu return NULL; 42511538d03SRoopa Prabhu } 42678851988SVlad Yasevich out: 42778851988SVlad Yasevich return skb; 42878851988SVlad Yasevich } 42978851988SVlad Yasevich 43078851988SVlad Yasevich /* Called under RCU */ 4316dada9b1SNikolay Aleksandrov static bool __allowed_ingress(const struct net_bridge *br, 4326dada9b1SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 43378851988SVlad Yasevich struct sk_buff *skb, u16 *vid) 43478851988SVlad Yasevich { 4356dada9b1SNikolay Aleksandrov struct br_vlan_stats *stats; 4366dada9b1SNikolay Aleksandrov struct net_bridge_vlan *v; 4378580e211SToshiaki Makita bool tagged; 438a37b85c9SVlad Yasevich 43920adfa1aSVlad Yasevich BR_INPUT_SKB_CB(skb)->vlan_filtered = true; 44012464bb8SToshiaki Makita /* If vlan tx offload is disabled on bridge device and frame was 44112464bb8SToshiaki Makita * sent from vlan device on the bridge device, it does not have 44212464bb8SToshiaki Makita * HW accelerated vlan tag. 44312464bb8SToshiaki Makita */ 444df8a39deSJiri Pirko if (unlikely(!skb_vlan_tag_present(skb) && 4456dada9b1SNikolay Aleksandrov skb->protocol == br->vlan_proto)) { 4460d5501c1SVlad Yasevich skb = skb_vlan_untag(skb); 44712464bb8SToshiaki Makita if (unlikely(!skb)) 44812464bb8SToshiaki Makita return false; 44912464bb8SToshiaki Makita } 45012464bb8SToshiaki Makita 4518580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid)) { 4528580e211SToshiaki Makita /* Tagged frame */ 4536dada9b1SNikolay Aleksandrov if (skb->vlan_proto != br->vlan_proto) { 4548580e211SToshiaki Makita /* Protocol-mismatch, empty out vlan_tci for new tag */ 4558580e211SToshiaki Makita skb_push(skb, ETH_HLEN); 45662749e2cSJiri Pirko skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto, 457df8a39deSJiri Pirko skb_vlan_tag_get(skb)); 4588580e211SToshiaki Makita if (unlikely(!skb)) 4598580e211SToshiaki Makita return false; 4608580e211SToshiaki Makita 4618580e211SToshiaki Makita skb_pull(skb, ETH_HLEN); 4628580e211SToshiaki Makita skb_reset_mac_len(skb); 4638580e211SToshiaki Makita *vid = 0; 4648580e211SToshiaki Makita tagged = false; 4658580e211SToshiaki Makita } else { 4668580e211SToshiaki Makita tagged = true; 4678580e211SToshiaki Makita } 4688580e211SToshiaki Makita } else { 4698580e211SToshiaki Makita /* Untagged frame */ 4708580e211SToshiaki Makita tagged = false; 4718580e211SToshiaki Makita } 4728580e211SToshiaki Makita 473b90356ceSToshiaki Makita if (!*vid) { 47477751ee8SNikolay Aleksandrov u16 pvid = br_get_pvid(vg); 47577751ee8SNikolay Aleksandrov 476b90356ceSToshiaki Makita /* Frame had a tag with VID 0 or did not have a tag. 477b90356ceSToshiaki Makita * See if pvid is set on this port. That tells us which 478b90356ceSToshiaki Makita * vlan untagged or priority-tagged traffic belongs to. 47978851988SVlad Yasevich */ 4803df6bf45SVlad Yasevich if (!pvid) 481eb707618SToshiaki Makita goto drop; 48278851988SVlad Yasevich 483b90356ceSToshiaki Makita /* PVID is set on this port. Any untagged or priority-tagged 484b90356ceSToshiaki Makita * ingress frame is considered to belong to this vlan. 48578851988SVlad Yasevich */ 486dfb5fa32SToshiaki Makita *vid = pvid; 4878580e211SToshiaki Makita if (likely(!tagged)) 488b90356ceSToshiaki Makita /* Untagged Frame. */ 4896dada9b1SNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, br->vlan_proto, pvid); 490b90356ceSToshiaki Makita else 491b90356ceSToshiaki Makita /* Priority-tagged Frame. 492b90356ceSToshiaki Makita * At this point, We know that skb->vlan_tci had 493b90356ceSToshiaki Makita * VLAN_TAG_PRESENT bit and its VID field was 0x000. 494b90356ceSToshiaki Makita * We update only VID field and preserve PCP field. 495b90356ceSToshiaki Makita */ 496b90356ceSToshiaki Makita skb->vlan_tci |= pvid; 497b90356ceSToshiaki Makita 4986dada9b1SNikolay Aleksandrov /* if stats are disabled we can avoid the lookup */ 499ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) 50078851988SVlad Yasevich return true; 50178851988SVlad Yasevich } 50277751ee8SNikolay Aleksandrov v = br_vlan_find(vg, *vid); 5036dada9b1SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) 5046dada9b1SNikolay Aleksandrov goto drop; 5056dada9b1SNikolay Aleksandrov 506ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { 5076dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 5086dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 5096dada9b1SNikolay Aleksandrov stats->rx_bytes += skb->len; 5106dada9b1SNikolay Aleksandrov stats->rx_packets++; 5116dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 5126dada9b1SNikolay Aleksandrov } 5136dada9b1SNikolay Aleksandrov 514a37b85c9SVlad Yasevich return true; 5156dada9b1SNikolay Aleksandrov 516eb707618SToshiaki Makita drop: 517eb707618SToshiaki Makita kfree_skb(skb); 518a37b85c9SVlad Yasevich return false; 519a37b85c9SVlad Yasevich } 520a37b85c9SVlad Yasevich 52177751ee8SNikolay Aleksandrov bool br_allowed_ingress(const struct net_bridge *br, 52277751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg, struct sk_buff *skb, 5232594e906SNikolay Aleksandrov u16 *vid) 5242594e906SNikolay Aleksandrov { 5252594e906SNikolay Aleksandrov /* If VLAN filtering is disabled on the bridge, all packets are 5262594e906SNikolay Aleksandrov * permitted. 5272594e906SNikolay Aleksandrov */ 528ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED)) { 5292594e906SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->vlan_filtered = false; 5302594e906SNikolay Aleksandrov return true; 5312594e906SNikolay Aleksandrov } 5322594e906SNikolay Aleksandrov 5336dada9b1SNikolay Aleksandrov return __allowed_ingress(br, vg, skb, vid); 5342594e906SNikolay Aleksandrov } 5352594e906SNikolay Aleksandrov 53685f46c6bSVlad Yasevich /* Called under RCU. */ 5372594e906SNikolay Aleksandrov bool br_allowed_egress(struct net_bridge_vlan_group *vg, 53885f46c6bSVlad Yasevich const struct sk_buff *skb) 53985f46c6bSVlad Yasevich { 5402594e906SNikolay Aleksandrov const struct net_bridge_vlan *v; 54185f46c6bSVlad Yasevich u16 vid; 54285f46c6bSVlad Yasevich 54320adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 54420adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 54585f46c6bSVlad Yasevich return true; 54685f46c6bSVlad Yasevich 54785f46c6bSVlad Yasevich br_vlan_get_tag(skb, &vid); 5482594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 5492594e906SNikolay Aleksandrov if (v && br_vlan_should_use(v)) 55085f46c6bSVlad Yasevich return true; 55185f46c6bSVlad Yasevich 55285f46c6bSVlad Yasevich return false; 55385f46c6bSVlad Yasevich } 55485f46c6bSVlad Yasevich 555e0d7968aSToshiaki Makita /* Called under RCU */ 556e0d7968aSToshiaki Makita bool br_should_learn(struct net_bridge_port *p, struct sk_buff *skb, u16 *vid) 557e0d7968aSToshiaki Makita { 558468e7944SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 559e0d7968aSToshiaki Makita struct net_bridge *br = p->br; 560e0d7968aSToshiaki Makita 56120adfa1aSVlad Yasevich /* If filtering was disabled at input, let it pass. */ 562ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED)) 563e0d7968aSToshiaki Makita return true; 564e0d7968aSToshiaki Makita 565eca1e006SIdo Schimmel vg = nbp_vlan_group_rcu(p); 566468e7944SNikolay Aleksandrov if (!vg || !vg->num_vlans) 567e0d7968aSToshiaki Makita return false; 568e0d7968aSToshiaki Makita 5698580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid) && skb->vlan_proto != br->vlan_proto) 5708580e211SToshiaki Makita *vid = 0; 5718580e211SToshiaki Makita 572e0d7968aSToshiaki Makita if (!*vid) { 57377751ee8SNikolay Aleksandrov *vid = br_get_pvid(vg); 5743df6bf45SVlad Yasevich if (!*vid) 575e0d7968aSToshiaki Makita return false; 576e0d7968aSToshiaki Makita 577e0d7968aSToshiaki Makita return true; 578e0d7968aSToshiaki Makita } 579e0d7968aSToshiaki Makita 58077751ee8SNikolay Aleksandrov if (br_vlan_find(vg, *vid)) 581e0d7968aSToshiaki Makita return true; 582e0d7968aSToshiaki Makita 583e0d7968aSToshiaki Makita return false; 584e0d7968aSToshiaki Makita } 585e0d7968aSToshiaki Makita 586dbd6dc75SPetr Machata static int br_vlan_add_existing(struct net_bridge *br, 587dbd6dc75SPetr Machata struct net_bridge_vlan_group *vg, 588dbd6dc75SPetr Machata struct net_bridge_vlan *vlan, 589dbd6dc75SPetr Machata u16 flags, bool *changed) 590dbd6dc75SPetr Machata { 591dbd6dc75SPetr Machata int err; 592dbd6dc75SPetr Machata 5939c86ce2cSPetr Machata err = br_switchdev_port_vlan_add(br->dev, vlan->vid, flags); 5949c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 5959c86ce2cSPetr Machata return err; 5969c86ce2cSPetr Machata 597dbd6dc75SPetr Machata if (!br_vlan_is_brentry(vlan)) { 598dbd6dc75SPetr Machata /* Trying to change flags of non-existent bridge vlan */ 5999c86ce2cSPetr Machata if (!(flags & BRIDGE_VLAN_INFO_BRENTRY)) { 6009c86ce2cSPetr Machata err = -EINVAL; 6019c86ce2cSPetr Machata goto err_flags; 6029c86ce2cSPetr Machata } 603dbd6dc75SPetr Machata /* It was only kept for port vlans, now make it real */ 604dbd6dc75SPetr Machata err = br_fdb_insert(br, NULL, br->dev->dev_addr, 605dbd6dc75SPetr Machata vlan->vid); 606dbd6dc75SPetr Machata if (err) { 607dbd6dc75SPetr Machata br_err(br, "failed to insert local address into bridge forwarding table\n"); 6089c86ce2cSPetr Machata goto err_fdb_insert; 609dbd6dc75SPetr Machata } 610dbd6dc75SPetr Machata 611dbd6dc75SPetr Machata refcount_inc(&vlan->refcnt); 612dbd6dc75SPetr Machata vlan->flags |= BRIDGE_VLAN_INFO_BRENTRY; 613dbd6dc75SPetr Machata vg->num_vlans++; 614dbd6dc75SPetr Machata *changed = true; 615dbd6dc75SPetr Machata } 616dbd6dc75SPetr Machata 617dbd6dc75SPetr Machata if (__vlan_add_flags(vlan, flags)) 618dbd6dc75SPetr Machata *changed = true; 619dbd6dc75SPetr Machata 620dbd6dc75SPetr Machata return 0; 6219c86ce2cSPetr Machata 6229c86ce2cSPetr Machata err_fdb_insert: 6239c86ce2cSPetr Machata err_flags: 6249c86ce2cSPetr Machata br_switchdev_port_vlan_del(br->dev, vlan->vid); 6259c86ce2cSPetr Machata return err; 626dbd6dc75SPetr Machata } 627dbd6dc75SPetr Machata 6288adff41cSToshiaki Makita /* Must be protected by RTNL. 6298adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 630f418af63SNikolay Aleksandrov * changed must be true only if the vlan was created or updated 6318adff41cSToshiaki Makita */ 632f418af63SNikolay Aleksandrov int br_vlan_add(struct net_bridge *br, u16 vid, u16 flags, bool *changed) 633243a2e63SVlad Yasevich { 634907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 6352594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 6362594e906SNikolay Aleksandrov int ret; 637243a2e63SVlad Yasevich 638243a2e63SVlad Yasevich ASSERT_RTNL(); 639243a2e63SVlad Yasevich 640f418af63SNikolay Aleksandrov *changed = false; 641907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 642907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(vg, vid); 643dbd6dc75SPetr Machata if (vlan) 644dbd6dc75SPetr Machata return br_vlan_add_existing(br, vg, vlan, flags, changed); 645243a2e63SVlad Yasevich 6462594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 6472594e906SNikolay Aleksandrov if (!vlan) 648243a2e63SVlad Yasevich return -ENOMEM; 649243a2e63SVlad Yasevich 6506dada9b1SNikolay Aleksandrov vlan->stats = netdev_alloc_pcpu_stats(struct br_vlan_stats); 6516dada9b1SNikolay Aleksandrov if (!vlan->stats) { 6526dada9b1SNikolay Aleksandrov kfree(vlan); 6536dada9b1SNikolay Aleksandrov return -ENOMEM; 6546dada9b1SNikolay Aleksandrov } 6552594e906SNikolay Aleksandrov vlan->vid = vid; 6562594e906SNikolay Aleksandrov vlan->flags = flags | BRIDGE_VLAN_INFO_MASTER; 6572594e906SNikolay Aleksandrov vlan->flags &= ~BRIDGE_VLAN_INFO_PVID; 6582594e906SNikolay Aleksandrov vlan->br = br; 6592594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_BRENTRY) 66025127759SReshetova, Elena refcount_set(&vlan->refcnt, 1); 6612594e906SNikolay Aleksandrov ret = __vlan_add(vlan, flags); 6626dada9b1SNikolay Aleksandrov if (ret) { 6636dada9b1SNikolay Aleksandrov free_percpu(vlan->stats); 6642594e906SNikolay Aleksandrov kfree(vlan); 665f418af63SNikolay Aleksandrov } else { 666f418af63SNikolay Aleksandrov *changed = true; 6676dada9b1SNikolay Aleksandrov } 668243a2e63SVlad Yasevich 6692594e906SNikolay Aleksandrov return ret; 670243a2e63SVlad Yasevich } 671243a2e63SVlad Yasevich 6728adff41cSToshiaki Makita /* Must be protected by RTNL. 6738adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 6748adff41cSToshiaki Makita */ 675243a2e63SVlad Yasevich int br_vlan_delete(struct net_bridge *br, u16 vid) 676243a2e63SVlad Yasevich { 677907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 6782594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 679243a2e63SVlad Yasevich 680243a2e63SVlad Yasevich ASSERT_RTNL(); 681243a2e63SVlad Yasevich 682907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 683907b1e6eSNikolay Aleksandrov v = br_vlan_find(vg, vid); 6842594e906SNikolay Aleksandrov if (!v || !br_vlan_is_brentry(v)) 6852594e906SNikolay Aleksandrov return -ENOENT; 686243a2e63SVlad Yasevich 687424bb9c9SToshiaki Makita br_fdb_find_delete_local(br, NULL, br->dev->dev_addr, vid); 6883741873bSRoopa Prabhu br_fdb_delete_by_port(br, NULL, vid, 0); 689bc9a25d2SVlad Yasevich 690efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 691efa5356bSRoopa Prabhu 6922594e906SNikolay Aleksandrov return __vlan_del(v); 693243a2e63SVlad Yasevich } 694243a2e63SVlad Yasevich 695243a2e63SVlad Yasevich void br_vlan_flush(struct net_bridge *br) 696243a2e63SVlad Yasevich { 697f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 698f409d0edSNikolay Aleksandrov 699243a2e63SVlad Yasevich ASSERT_RTNL(); 700243a2e63SVlad Yasevich 701f409d0edSNikolay Aleksandrov vg = br_vlan_group(br); 702f409d0edSNikolay Aleksandrov __vlan_flush(vg); 703f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(br->vlgrp, NULL); 704f409d0edSNikolay Aleksandrov synchronize_rcu(); 705f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 706243a2e63SVlad Yasevich } 707243a2e63SVlad Yasevich 7082594e906SNikolay Aleksandrov struct net_bridge_vlan *br_vlan_find(struct net_bridge_vlan_group *vg, u16 vid) 7092b292fb4SToshiaki Makita { 7102594e906SNikolay Aleksandrov if (!vg) 7112594e906SNikolay Aleksandrov return NULL; 7122b292fb4SToshiaki Makita 7132594e906SNikolay Aleksandrov return br_vlan_lookup(&vg->vlan_hash, vid); 7142b292fb4SToshiaki Makita } 7152b292fb4SToshiaki Makita 716204177f3SToshiaki Makita /* Must be protected by RTNL. */ 717204177f3SToshiaki Makita static void recalculate_group_addr(struct net_bridge *br) 718204177f3SToshiaki Makita { 719be3664a0SNikolay Aleksandrov if (br_opt_get(br, BROPT_GROUP_ADDR_SET)) 720204177f3SToshiaki Makita return; 721204177f3SToshiaki Makita 722204177f3SToshiaki Makita spin_lock_bh(&br->lock); 723ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED) || 724ae75767eSNikolay Aleksandrov br->vlan_proto == htons(ETH_P_8021Q)) { 725204177f3SToshiaki Makita /* Bridge Group Address */ 726204177f3SToshiaki Makita br->group_addr[5] = 0x00; 727204177f3SToshiaki Makita } else { /* vlan_enabled && ETH_P_8021AD */ 728204177f3SToshiaki Makita /* Provider Bridge Group Address */ 729204177f3SToshiaki Makita br->group_addr[5] = 0x08; 730204177f3SToshiaki Makita } 731204177f3SToshiaki Makita spin_unlock_bh(&br->lock); 732204177f3SToshiaki Makita } 733204177f3SToshiaki Makita 734204177f3SToshiaki Makita /* Must be protected by RTNL. */ 735204177f3SToshiaki Makita void br_recalculate_fwd_mask(struct net_bridge *br) 736204177f3SToshiaki Makita { 737ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED) || 738ae75767eSNikolay Aleksandrov br->vlan_proto == htons(ETH_P_8021Q)) 739204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_DEFAULT; 740204177f3SToshiaki Makita else /* vlan_enabled && ETH_P_8021AD */ 741204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_8021AD & 742204177f3SToshiaki Makita ~(1u << br->group_addr[5]); 743204177f3SToshiaki Makita } 744204177f3SToshiaki Makita 745a7854037SNikolay Aleksandrov int __br_vlan_filter_toggle(struct net_bridge *br, unsigned long val) 746243a2e63SVlad Yasevich { 7476b72a770SElad Raz struct switchdev_attr attr = { 7486b72a770SElad Raz .orig_dev = br->dev, 7496b72a770SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 7506b72a770SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 7516b72a770SElad Raz .u.vlan_filtering = val, 7526b72a770SElad Raz }; 7536b72a770SElad Raz int err; 7546b72a770SElad Raz 755ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_ENABLED) == !!val) 756a7854037SNikolay Aleksandrov return 0; 757243a2e63SVlad Yasevich 7586b72a770SElad Raz err = switchdev_port_attr_set(br->dev, &attr); 7596b72a770SElad Raz if (err && err != -EOPNOTSUPP) 7606b72a770SElad Raz return err; 7616b72a770SElad Raz 762ae75767eSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_ENABLED, !!val); 7632796d0c6SVlad Yasevich br_manage_promisc(br); 764204177f3SToshiaki Makita recalculate_group_addr(br); 765204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 766243a2e63SVlad Yasevich 767a7854037SNikolay Aleksandrov return 0; 768a7854037SNikolay Aleksandrov } 769a7854037SNikolay Aleksandrov 770a7854037SNikolay Aleksandrov int br_vlan_filter_toggle(struct net_bridge *br, unsigned long val) 771a7854037SNikolay Aleksandrov { 772047831a9SXin Long return __br_vlan_filter_toggle(br, val); 773243a2e63SVlad Yasevich } 774243a2e63SVlad Yasevich 7751f51445aSIdo Schimmel bool br_vlan_enabled(const struct net_device *dev) 7761f51445aSIdo Schimmel { 7771f51445aSIdo Schimmel struct net_bridge *br = netdev_priv(dev); 7781f51445aSIdo Schimmel 779ae75767eSNikolay Aleksandrov return br_opt_get(br, BROPT_VLAN_ENABLED); 7801f51445aSIdo Schimmel } 7811f51445aSIdo Schimmel EXPORT_SYMBOL_GPL(br_vlan_enabled); 7821f51445aSIdo Schimmel 783d2d427b3SToshiaki Makita int __br_vlan_set_proto(struct net_bridge *br, __be16 proto) 784204177f3SToshiaki Makita { 785204177f3SToshiaki Makita int err = 0; 786204177f3SToshiaki Makita struct net_bridge_port *p; 7872594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 788907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 789d2d427b3SToshiaki Makita __be16 oldproto; 790204177f3SToshiaki Makita 791204177f3SToshiaki Makita if (br->vlan_proto == proto) 792d2d427b3SToshiaki Makita return 0; 793204177f3SToshiaki Makita 794204177f3SToshiaki Makita /* Add VLANs for the new proto to the device filter. */ 795204177f3SToshiaki Makita list_for_each_entry(p, &br->port_list, list) { 796907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 797907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 7982594e906SNikolay Aleksandrov err = vlan_vid_add(p->dev, proto, vlan->vid); 799204177f3SToshiaki Makita if (err) 800204177f3SToshiaki Makita goto err_filt; 801204177f3SToshiaki Makita } 802204177f3SToshiaki Makita } 803204177f3SToshiaki Makita 804204177f3SToshiaki Makita oldproto = br->vlan_proto; 805204177f3SToshiaki Makita br->vlan_proto = proto; 806204177f3SToshiaki Makita 807204177f3SToshiaki Makita recalculate_group_addr(br); 808204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 809204177f3SToshiaki Makita 810204177f3SToshiaki Makita /* Delete VLANs for the old proto from the device filter. */ 811907b1e6eSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 812907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 813907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 8142594e906SNikolay Aleksandrov vlan_vid_del(p->dev, oldproto, vlan->vid); 815907b1e6eSNikolay Aleksandrov } 816204177f3SToshiaki Makita 817d2d427b3SToshiaki Makita return 0; 818204177f3SToshiaki Makita 819204177f3SToshiaki Makita err_filt: 820907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(vlan, &vg->vlan_list, vlist) 8212594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 822204177f3SToshiaki Makita 823907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(p, &br->port_list, list) { 824907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 825907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 8262594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 827907b1e6eSNikolay Aleksandrov } 828204177f3SToshiaki Makita 829d2d427b3SToshiaki Makita return err; 830d2d427b3SToshiaki Makita } 831d2d427b3SToshiaki Makita 832d2d427b3SToshiaki Makita int br_vlan_set_proto(struct net_bridge *br, unsigned long val) 833d2d427b3SToshiaki Makita { 834d2d427b3SToshiaki Makita if (val != ETH_P_8021Q && val != ETH_P_8021AD) 835d2d427b3SToshiaki Makita return -EPROTONOSUPPORT; 836d2d427b3SToshiaki Makita 837047831a9SXin Long return __br_vlan_set_proto(br, htons(val)); 838204177f3SToshiaki Makita } 839204177f3SToshiaki Makita 8406dada9b1SNikolay Aleksandrov int br_vlan_set_stats(struct net_bridge *br, unsigned long val) 8416dada9b1SNikolay Aleksandrov { 8426dada9b1SNikolay Aleksandrov switch (val) { 8436dada9b1SNikolay Aleksandrov case 0: 8446dada9b1SNikolay Aleksandrov case 1: 845ae75767eSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_STATS_ENABLED, !!val); 8466dada9b1SNikolay Aleksandrov break; 8476dada9b1SNikolay Aleksandrov default: 8486dada9b1SNikolay Aleksandrov return -EINVAL; 8496dada9b1SNikolay Aleksandrov } 8506dada9b1SNikolay Aleksandrov 8516dada9b1SNikolay Aleksandrov return 0; 8526dada9b1SNikolay Aleksandrov } 8536dada9b1SNikolay Aleksandrov 8549163a0fcSNikolay Aleksandrov int br_vlan_set_stats_per_port(struct net_bridge *br, unsigned long val) 8559163a0fcSNikolay Aleksandrov { 8569163a0fcSNikolay Aleksandrov struct net_bridge_port *p; 8579163a0fcSNikolay Aleksandrov 8589163a0fcSNikolay Aleksandrov /* allow to change the option if there are no port vlans configured */ 8599163a0fcSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 8609163a0fcSNikolay Aleksandrov struct net_bridge_vlan_group *vg = nbp_vlan_group(p); 8619163a0fcSNikolay Aleksandrov 8629163a0fcSNikolay Aleksandrov if (vg->num_vlans) 8639163a0fcSNikolay Aleksandrov return -EBUSY; 8649163a0fcSNikolay Aleksandrov } 8659163a0fcSNikolay Aleksandrov 8669163a0fcSNikolay Aleksandrov switch (val) { 8679163a0fcSNikolay Aleksandrov case 0: 8689163a0fcSNikolay Aleksandrov case 1: 8699163a0fcSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_STATS_PER_PORT, !!val); 8709163a0fcSNikolay Aleksandrov break; 8719163a0fcSNikolay Aleksandrov default: 8729163a0fcSNikolay Aleksandrov return -EINVAL; 8739163a0fcSNikolay Aleksandrov } 8749163a0fcSNikolay Aleksandrov 8759163a0fcSNikolay Aleksandrov return 0; 8769163a0fcSNikolay Aleksandrov } 8779163a0fcSNikolay Aleksandrov 87877751ee8SNikolay Aleksandrov static bool vlan_default_pvid(struct net_bridge_vlan_group *vg, u16 vid) 8795be5a2dfSVlad Yasevich { 8802594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 8812594e906SNikolay Aleksandrov 88277751ee8SNikolay Aleksandrov if (vid != vg->pvid) 8832594e906SNikolay Aleksandrov return false; 8842594e906SNikolay Aleksandrov 8852594e906SNikolay Aleksandrov v = br_vlan_lookup(&vg->vlan_hash, vid); 8862594e906SNikolay Aleksandrov if (v && br_vlan_should_use(v) && 8872594e906SNikolay Aleksandrov (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) 8882594e906SNikolay Aleksandrov return true; 8892594e906SNikolay Aleksandrov 8902594e906SNikolay Aleksandrov return false; 8915be5a2dfSVlad Yasevich } 8925be5a2dfSVlad Yasevich 8935be5a2dfSVlad Yasevich static void br_vlan_disable_default_pvid(struct net_bridge *br) 8945be5a2dfSVlad Yasevich { 8955be5a2dfSVlad Yasevich struct net_bridge_port *p; 8965be5a2dfSVlad Yasevich u16 pvid = br->default_pvid; 8975be5a2dfSVlad Yasevich 8985be5a2dfSVlad Yasevich /* Disable default_pvid on all ports where it is still 8995be5a2dfSVlad Yasevich * configured. 9005be5a2dfSVlad Yasevich */ 901907b1e6eSNikolay Aleksandrov if (vlan_default_pvid(br_vlan_group(br), pvid)) 9025be5a2dfSVlad Yasevich br_vlan_delete(br, pvid); 9035be5a2dfSVlad Yasevich 9045be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 905907b1e6eSNikolay Aleksandrov if (vlan_default_pvid(nbp_vlan_group(p), pvid)) 9065be5a2dfSVlad Yasevich nbp_vlan_delete(p, pvid); 9075be5a2dfSVlad Yasevich } 9085be5a2dfSVlad Yasevich 9095be5a2dfSVlad Yasevich br->default_pvid = 0; 9105be5a2dfSVlad Yasevich } 9115be5a2dfSVlad Yasevich 9120f963b75SNikolay Aleksandrov int __br_vlan_set_default_pvid(struct net_bridge *br, u16 pvid) 9135be5a2dfSVlad Yasevich { 9142594e906SNikolay Aleksandrov const struct net_bridge_vlan *pvent; 915907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 9165be5a2dfSVlad Yasevich struct net_bridge_port *p; 917f418af63SNikolay Aleksandrov unsigned long *changed; 918f418af63SNikolay Aleksandrov bool vlchange; 9195be5a2dfSVlad Yasevich u16 old_pvid; 9205be5a2dfSVlad Yasevich int err = 0; 9215be5a2dfSVlad Yasevich 9220f963b75SNikolay Aleksandrov if (!pvid) { 9230f963b75SNikolay Aleksandrov br_vlan_disable_default_pvid(br); 9240f963b75SNikolay Aleksandrov return 0; 9250f963b75SNikolay Aleksandrov } 9260f963b75SNikolay Aleksandrov 927459479daSAndy Shevchenko changed = bitmap_zalloc(BR_MAX_PORTS, GFP_KERNEL); 9285be5a2dfSVlad Yasevich if (!changed) 9295be5a2dfSVlad Yasevich return -ENOMEM; 9305be5a2dfSVlad Yasevich 9315be5a2dfSVlad Yasevich old_pvid = br->default_pvid; 9325be5a2dfSVlad Yasevich 9335be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 9345be5a2dfSVlad Yasevich * user configuration. 9355be5a2dfSVlad Yasevich */ 936907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 937907b1e6eSNikolay Aleksandrov pvent = br_vlan_find(vg, pvid); 938907b1e6eSNikolay Aleksandrov if ((!old_pvid || vlan_default_pvid(vg, old_pvid)) && 9392594e906SNikolay Aleksandrov (!pvent || !br_vlan_should_use(pvent))) { 9405be5a2dfSVlad Yasevich err = br_vlan_add(br, pvid, 9415be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 9422594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 943f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, 944f418af63SNikolay Aleksandrov &vlchange); 9455be5a2dfSVlad Yasevich if (err) 9465be5a2dfSVlad Yasevich goto out; 9475be5a2dfSVlad Yasevich br_vlan_delete(br, old_pvid); 9485be5a2dfSVlad Yasevich set_bit(0, changed); 9495be5a2dfSVlad Yasevich } 9505be5a2dfSVlad Yasevich 9515be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 9525be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 9535be5a2dfSVlad Yasevich * user configuration. 9545be5a2dfSVlad Yasevich */ 955907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 9565be5a2dfSVlad Yasevich if ((old_pvid && 957907b1e6eSNikolay Aleksandrov !vlan_default_pvid(vg, old_pvid)) || 958907b1e6eSNikolay Aleksandrov br_vlan_find(vg, pvid)) 9595be5a2dfSVlad Yasevich continue; 9605be5a2dfSVlad Yasevich 9615be5a2dfSVlad Yasevich err = nbp_vlan_add(p, pvid, 9625be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 963f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 964f418af63SNikolay Aleksandrov &vlchange); 9655be5a2dfSVlad Yasevich if (err) 9665be5a2dfSVlad Yasevich goto err_port; 9675be5a2dfSVlad Yasevich nbp_vlan_delete(p, old_pvid); 9685be5a2dfSVlad Yasevich set_bit(p->port_no, changed); 9695be5a2dfSVlad Yasevich } 9705be5a2dfSVlad Yasevich 9715be5a2dfSVlad Yasevich br->default_pvid = pvid; 9725be5a2dfSVlad Yasevich 9735be5a2dfSVlad Yasevich out: 974459479daSAndy Shevchenko bitmap_free(changed); 9755be5a2dfSVlad Yasevich return err; 9765be5a2dfSVlad Yasevich 9775be5a2dfSVlad Yasevich err_port: 9785be5a2dfSVlad Yasevich list_for_each_entry_continue_reverse(p, &br->port_list, list) { 9795be5a2dfSVlad Yasevich if (!test_bit(p->port_no, changed)) 9805be5a2dfSVlad Yasevich continue; 9815be5a2dfSVlad Yasevich 9825be5a2dfSVlad Yasevich if (old_pvid) 9835be5a2dfSVlad Yasevich nbp_vlan_add(p, old_pvid, 9845be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 985f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 986f418af63SNikolay Aleksandrov &vlchange); 9875be5a2dfSVlad Yasevich nbp_vlan_delete(p, pvid); 9885be5a2dfSVlad Yasevich } 9895be5a2dfSVlad Yasevich 9905be5a2dfSVlad Yasevich if (test_bit(0, changed)) { 9915be5a2dfSVlad Yasevich if (old_pvid) 9925be5a2dfSVlad Yasevich br_vlan_add(br, old_pvid, 9935be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 9942594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 995f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, 996f418af63SNikolay Aleksandrov &vlchange); 9975be5a2dfSVlad Yasevich br_vlan_delete(br, pvid); 9985be5a2dfSVlad Yasevich } 9995be5a2dfSVlad Yasevich goto out; 10005be5a2dfSVlad Yasevich } 10015be5a2dfSVlad Yasevich 100296a20d9dSVlad Yasevich int br_vlan_set_default_pvid(struct net_bridge *br, unsigned long val) 100396a20d9dSVlad Yasevich { 100496a20d9dSVlad Yasevich u16 pvid = val; 100596a20d9dSVlad Yasevich int err = 0; 100696a20d9dSVlad Yasevich 10075be5a2dfSVlad Yasevich if (val >= VLAN_VID_MASK) 100896a20d9dSVlad Yasevich return -EINVAL; 100996a20d9dSVlad Yasevich 101096a20d9dSVlad Yasevich if (pvid == br->default_pvid) 1011047831a9SXin Long goto out; 101296a20d9dSVlad Yasevich 101396a20d9dSVlad Yasevich /* Only allow default pvid change when filtering is disabled */ 1014ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_ENABLED)) { 101596a20d9dSVlad Yasevich pr_info_once("Please disable vlan filtering to change default_pvid\n"); 101696a20d9dSVlad Yasevich err = -EPERM; 1017047831a9SXin Long goto out; 101896a20d9dSVlad Yasevich } 10195be5a2dfSVlad Yasevich err = __br_vlan_set_default_pvid(br, pvid); 1020047831a9SXin Long out: 102196a20d9dSVlad Yasevich return err; 102296a20d9dSVlad Yasevich } 102396a20d9dSVlad Yasevich 10245be5a2dfSVlad Yasevich int br_vlan_init(struct net_bridge *br) 10258580e211SToshiaki Makita { 1026907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 10272594e906SNikolay Aleksandrov int ret = -ENOMEM; 1028f418af63SNikolay Aleksandrov bool changed; 10292594e906SNikolay Aleksandrov 1030907b1e6eSNikolay Aleksandrov vg = kzalloc(sizeof(*vg), GFP_KERNEL); 1031907b1e6eSNikolay Aleksandrov if (!vg) 10322594e906SNikolay Aleksandrov goto out; 1033907b1e6eSNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 10342594e906SNikolay Aleksandrov if (ret) 10352594e906SNikolay Aleksandrov goto err_rhtbl; 1036efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 1037efa5356bSRoopa Prabhu if (ret) 1038efa5356bSRoopa Prabhu goto err_tunnel_init; 1039907b1e6eSNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 10408580e211SToshiaki Makita br->vlan_proto = htons(ETH_P_8021Q); 104196a20d9dSVlad Yasevich br->default_pvid = 1; 1042907b1e6eSNikolay Aleksandrov rcu_assign_pointer(br->vlgrp, vg); 10432594e906SNikolay Aleksandrov ret = br_vlan_add(br, 1, 10442594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | BRIDGE_VLAN_INFO_UNTAGGED | 1045f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, &changed); 10462594e906SNikolay Aleksandrov if (ret) 10472594e906SNikolay Aleksandrov goto err_vlan_add; 10482594e906SNikolay Aleksandrov 10492594e906SNikolay Aleksandrov out: 10502594e906SNikolay Aleksandrov return ret; 10512594e906SNikolay Aleksandrov 10522594e906SNikolay Aleksandrov err_vlan_add: 1053efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 1054efa5356bSRoopa Prabhu err_tunnel_init: 1055907b1e6eSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 10562594e906SNikolay Aleksandrov err_rhtbl: 1057907b1e6eSNikolay Aleksandrov kfree(vg); 10582594e906SNikolay Aleksandrov 10592594e906SNikolay Aleksandrov goto out; 10602594e906SNikolay Aleksandrov } 10612594e906SNikolay Aleksandrov 10622594e906SNikolay Aleksandrov int nbp_vlan_init(struct net_bridge_port *p) 10632594e906SNikolay Aleksandrov { 1064404cdbf0SElad Raz struct switchdev_attr attr = { 1065404cdbf0SElad Raz .orig_dev = p->br->dev, 1066404cdbf0SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 1067404cdbf0SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 1068ae75767eSNikolay Aleksandrov .u.vlan_filtering = br_opt_get(p->br, BROPT_VLAN_ENABLED), 1069404cdbf0SElad Raz }; 1070263344e6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 10712594e906SNikolay Aleksandrov int ret = -ENOMEM; 10722594e906SNikolay Aleksandrov 1073263344e6SNikolay Aleksandrov vg = kzalloc(sizeof(struct net_bridge_vlan_group), GFP_KERNEL); 1074263344e6SNikolay Aleksandrov if (!vg) 10752594e906SNikolay Aleksandrov goto out; 10762594e906SNikolay Aleksandrov 1077404cdbf0SElad Raz ret = switchdev_port_attr_set(p->dev, &attr); 1078404cdbf0SElad Raz if (ret && ret != -EOPNOTSUPP) 1079404cdbf0SElad Raz goto err_vlan_enabled; 1080404cdbf0SElad Raz 1081263344e6SNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 10822594e906SNikolay Aleksandrov if (ret) 10832594e906SNikolay Aleksandrov goto err_rhtbl; 1084efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 1085efa5356bSRoopa Prabhu if (ret) 1086efa5356bSRoopa Prabhu goto err_tunnel_init; 1087263344e6SNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 1088907b1e6eSNikolay Aleksandrov rcu_assign_pointer(p->vlgrp, vg); 10892594e906SNikolay Aleksandrov if (p->br->default_pvid) { 1090f418af63SNikolay Aleksandrov bool changed; 1091f418af63SNikolay Aleksandrov 10922594e906SNikolay Aleksandrov ret = nbp_vlan_add(p, p->br->default_pvid, 10932594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | 1094f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 1095f418af63SNikolay Aleksandrov &changed); 10962594e906SNikolay Aleksandrov if (ret) 10972594e906SNikolay Aleksandrov goto err_vlan_add; 10982594e906SNikolay Aleksandrov } 10992594e906SNikolay Aleksandrov out: 11002594e906SNikolay Aleksandrov return ret; 11012594e906SNikolay Aleksandrov 11022594e906SNikolay Aleksandrov err_vlan_add: 110307bc588fSIdo Schimmel RCU_INIT_POINTER(p->vlgrp, NULL); 110407bc588fSIdo Schimmel synchronize_rcu(); 1105efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 1106efa5356bSRoopa Prabhu err_tunnel_init: 1107efa5356bSRoopa Prabhu rhashtable_destroy(&vg->vlan_hash); 11082594e906SNikolay Aleksandrov err_rhtbl: 1109df2c4334SYotam Gigi err_vlan_enabled: 1110263344e6SNikolay Aleksandrov kfree(vg); 11112594e906SNikolay Aleksandrov 11122594e906SNikolay Aleksandrov goto out; 11138580e211SToshiaki Makita } 11148580e211SToshiaki Makita 11158adff41cSToshiaki Makita /* Must be protected by RTNL. 11168adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 1117f418af63SNikolay Aleksandrov * changed must be true only if the vlan was created or updated 11188adff41cSToshiaki Makita */ 1119f418af63SNikolay Aleksandrov int nbp_vlan_add(struct net_bridge_port *port, u16 vid, u16 flags, 1120f418af63SNikolay Aleksandrov bool *changed) 1121243a2e63SVlad Yasevich { 11222594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 11232594e906SNikolay Aleksandrov int ret; 1124243a2e63SVlad Yasevich 1125243a2e63SVlad Yasevich ASSERT_RTNL(); 1126243a2e63SVlad Yasevich 1127f418af63SNikolay Aleksandrov *changed = false; 1128907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group(port), vid); 11292594e906SNikolay Aleksandrov if (vlan) { 11307fbac984SIdo Schimmel /* Pass the flags to the hardware bridge */ 1131d66e4348SPetr Machata ret = br_switchdev_port_vlan_add(port->dev, vid, flags); 11327fbac984SIdo Schimmel if (ret && ret != -EOPNOTSUPP) 11337fbac984SIdo Schimmel return ret; 1134f418af63SNikolay Aleksandrov *changed = __vlan_add_flags(vlan, flags); 1135f418af63SNikolay Aleksandrov 11362594e906SNikolay Aleksandrov return 0; 1137243a2e63SVlad Yasevich } 1138243a2e63SVlad Yasevich 11392594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 11402594e906SNikolay Aleksandrov if (!vlan) 11412594e906SNikolay Aleksandrov return -ENOMEM; 1142243a2e63SVlad Yasevich 11432594e906SNikolay Aleksandrov vlan->vid = vid; 11442594e906SNikolay Aleksandrov vlan->port = port; 11452594e906SNikolay Aleksandrov ret = __vlan_add(vlan, flags); 11462594e906SNikolay Aleksandrov if (ret) 11472594e906SNikolay Aleksandrov kfree(vlan); 1148f418af63SNikolay Aleksandrov else 1149f418af63SNikolay Aleksandrov *changed = true; 1150243a2e63SVlad Yasevich 11512594e906SNikolay Aleksandrov return ret; 1152243a2e63SVlad Yasevich } 1153243a2e63SVlad Yasevich 11548adff41cSToshiaki Makita /* Must be protected by RTNL. 11558adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 11568adff41cSToshiaki Makita */ 1157243a2e63SVlad Yasevich int nbp_vlan_delete(struct net_bridge_port *port, u16 vid) 1158243a2e63SVlad Yasevich { 11592594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 1160243a2e63SVlad Yasevich 1161243a2e63SVlad Yasevich ASSERT_RTNL(); 1162243a2e63SVlad Yasevich 1163907b1e6eSNikolay Aleksandrov v = br_vlan_find(nbp_vlan_group(port), vid); 11642594e906SNikolay Aleksandrov if (!v) 11652594e906SNikolay Aleksandrov return -ENOENT; 1166424bb9c9SToshiaki Makita br_fdb_find_delete_local(port->br, port, port->dev->dev_addr, vid); 11671ea2d020SNikolay Aleksandrov br_fdb_delete_by_port(port->br, port, vid, 0); 1168bc9a25d2SVlad Yasevich 11692594e906SNikolay Aleksandrov return __vlan_del(v); 1170243a2e63SVlad Yasevich } 1171243a2e63SVlad Yasevich 1172243a2e63SVlad Yasevich void nbp_vlan_flush(struct net_bridge_port *port) 1173243a2e63SVlad Yasevich { 1174f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 1175f409d0edSNikolay Aleksandrov 1176243a2e63SVlad Yasevich ASSERT_RTNL(); 1177243a2e63SVlad Yasevich 1178f409d0edSNikolay Aleksandrov vg = nbp_vlan_group(port); 1179f409d0edSNikolay Aleksandrov __vlan_flush(vg); 1180f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(port->vlgrp, NULL); 1181f409d0edSNikolay Aleksandrov synchronize_rcu(); 1182f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 11835be5a2dfSVlad Yasevich } 1184a60c0903SNikolay Aleksandrov 1185a60c0903SNikolay Aleksandrov void br_vlan_get_stats(const struct net_bridge_vlan *v, 1186a60c0903SNikolay Aleksandrov struct br_vlan_stats *stats) 1187a60c0903SNikolay Aleksandrov { 1188a60c0903SNikolay Aleksandrov int i; 1189a60c0903SNikolay Aleksandrov 1190a60c0903SNikolay Aleksandrov memset(stats, 0, sizeof(*stats)); 1191a60c0903SNikolay Aleksandrov for_each_possible_cpu(i) { 1192a60c0903SNikolay Aleksandrov u64 rxpackets, rxbytes, txpackets, txbytes; 1193a60c0903SNikolay Aleksandrov struct br_vlan_stats *cpu_stats; 1194a60c0903SNikolay Aleksandrov unsigned int start; 1195a60c0903SNikolay Aleksandrov 1196a60c0903SNikolay Aleksandrov cpu_stats = per_cpu_ptr(v->stats, i); 1197a60c0903SNikolay Aleksandrov do { 1198a60c0903SNikolay Aleksandrov start = u64_stats_fetch_begin_irq(&cpu_stats->syncp); 1199a60c0903SNikolay Aleksandrov rxpackets = cpu_stats->rx_packets; 1200a60c0903SNikolay Aleksandrov rxbytes = cpu_stats->rx_bytes; 1201a60c0903SNikolay Aleksandrov txbytes = cpu_stats->tx_bytes; 1202a60c0903SNikolay Aleksandrov txpackets = cpu_stats->tx_packets; 1203a60c0903SNikolay Aleksandrov } while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start)); 1204a60c0903SNikolay Aleksandrov 1205a60c0903SNikolay Aleksandrov stats->rx_packets += rxpackets; 1206a60c0903SNikolay Aleksandrov stats->rx_bytes += rxbytes; 1207a60c0903SNikolay Aleksandrov stats->tx_bytes += txbytes; 1208a60c0903SNikolay Aleksandrov stats->tx_packets += txpackets; 1209a60c0903SNikolay Aleksandrov } 1210a60c0903SNikolay Aleksandrov } 12114d4fd361SPetr Machata 12124d4fd361SPetr Machata int br_vlan_get_pvid(const struct net_device *dev, u16 *p_pvid) 12134d4fd361SPetr Machata { 12144d4fd361SPetr Machata struct net_bridge_vlan_group *vg; 12154d4fd361SPetr Machata 12164d4fd361SPetr Machata ASSERT_RTNL(); 12174d4fd361SPetr Machata if (netif_is_bridge_master(dev)) 12184d4fd361SPetr Machata vg = br_vlan_group(netdev_priv(dev)); 12194d4fd361SPetr Machata else 12204d4fd361SPetr Machata return -EINVAL; 12214d4fd361SPetr Machata 12224d4fd361SPetr Machata *p_pvid = br_get_pvid(vg); 12234d4fd361SPetr Machata return 0; 12244d4fd361SPetr Machata } 12254d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_pvid); 12264d4fd361SPetr Machata 12274d4fd361SPetr Machata int br_vlan_get_info(const struct net_device *dev, u16 vid, 12284d4fd361SPetr Machata struct bridge_vlan_info *p_vinfo) 12294d4fd361SPetr Machata { 12304d4fd361SPetr Machata struct net_bridge_vlan_group *vg; 12314d4fd361SPetr Machata struct net_bridge_vlan *v; 12324d4fd361SPetr Machata struct net_bridge_port *p; 12334d4fd361SPetr Machata 12344d4fd361SPetr Machata ASSERT_RTNL(); 12354d4fd361SPetr Machata p = br_port_get_check_rtnl(dev); 12364d4fd361SPetr Machata if (p) 12374d4fd361SPetr Machata vg = nbp_vlan_group(p); 12382b18d79eSPetr Machata else if (netif_is_bridge_master(dev)) 12392b18d79eSPetr Machata vg = br_vlan_group(netdev_priv(dev)); 12404d4fd361SPetr Machata else 12414d4fd361SPetr Machata return -EINVAL; 12424d4fd361SPetr Machata 12434d4fd361SPetr Machata v = br_vlan_find(vg, vid); 12444d4fd361SPetr Machata if (!v) 12454d4fd361SPetr Machata return -ENOENT; 12464d4fd361SPetr Machata 12474d4fd361SPetr Machata p_vinfo->vid = vid; 12484d4fd361SPetr Machata p_vinfo->flags = v->flags; 12494d4fd361SPetr Machata return 0; 12504d4fd361SPetr Machata } 12514d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_info); 1252