1457c8996SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 2243a2e63SVlad Yasevich #include <linux/kernel.h> 3243a2e63SVlad Yasevich #include <linux/netdevice.h> 4243a2e63SVlad Yasevich #include <linux/rtnetlink.h> 5243a2e63SVlad Yasevich #include <linux/slab.h> 67f109539SScott Feldman #include <net/switchdev.h> 7243a2e63SVlad Yasevich 8243a2e63SVlad Yasevich #include "br_private.h" 9efa5356bSRoopa Prabhu #include "br_private_tunnel.h" 10243a2e63SVlad Yasevich 1180900acdSMike Manning static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid); 1280900acdSMike Manning 132594e906SNikolay Aleksandrov static inline int br_vlan_cmp(struct rhashtable_compare_arg *arg, 142594e906SNikolay Aleksandrov const void *ptr) 15552406c4SVlad Yasevich { 162594e906SNikolay Aleksandrov const struct net_bridge_vlan *vle = ptr; 172594e906SNikolay Aleksandrov u16 vid = *(u16 *)arg->key; 182594e906SNikolay Aleksandrov 192594e906SNikolay Aleksandrov return vle->vid != vid; 202594e906SNikolay Aleksandrov } 212594e906SNikolay Aleksandrov 222594e906SNikolay Aleksandrov static const struct rhashtable_params br_vlan_rht_params = { 232594e906SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_vlan, vnode), 242594e906SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_vlan, vid), 252594e906SNikolay Aleksandrov .key_len = sizeof(u16), 268af78b64SNikolay Aleksandrov .nelem_hint = 3, 272594e906SNikolay Aleksandrov .max_size = VLAN_N_VID, 282594e906SNikolay Aleksandrov .obj_cmpfn = br_vlan_cmp, 292594e906SNikolay Aleksandrov .automatic_shrinking = true, 302594e906SNikolay Aleksandrov }; 312594e906SNikolay Aleksandrov 322594e906SNikolay Aleksandrov static struct net_bridge_vlan *br_vlan_lookup(struct rhashtable *tbl, u16 vid) 332594e906SNikolay Aleksandrov { 342594e906SNikolay Aleksandrov return rhashtable_lookup_fast(tbl, &vid, br_vlan_rht_params); 352594e906SNikolay Aleksandrov } 362594e906SNikolay Aleksandrov 37a580c76dSNikolay Aleksandrov static bool __vlan_add_pvid(struct net_bridge_vlan_group *vg, 38a580c76dSNikolay Aleksandrov const struct net_bridge_vlan *v) 392594e906SNikolay Aleksandrov { 40a580c76dSNikolay Aleksandrov if (vg->pvid == v->vid) 41f418af63SNikolay Aleksandrov return false; 42552406c4SVlad Yasevich 43552406c4SVlad Yasevich smp_wmb(); 44a580c76dSNikolay Aleksandrov br_vlan_set_pvid_state(vg, v->state); 45a580c76dSNikolay Aleksandrov vg->pvid = v->vid; 46f418af63SNikolay Aleksandrov 47f418af63SNikolay Aleksandrov return true; 48552406c4SVlad Yasevich } 49552406c4SVlad Yasevich 50f418af63SNikolay Aleksandrov static bool __vlan_delete_pvid(struct net_bridge_vlan_group *vg, u16 vid) 51552406c4SVlad Yasevich { 5277751ee8SNikolay Aleksandrov if (vg->pvid != vid) 53f418af63SNikolay Aleksandrov return false; 54552406c4SVlad Yasevich 55552406c4SVlad Yasevich smp_wmb(); 5677751ee8SNikolay Aleksandrov vg->pvid = 0; 57f418af63SNikolay Aleksandrov 58f418af63SNikolay Aleksandrov return true; 59552406c4SVlad Yasevich } 60552406c4SVlad Yasevich 61f418af63SNikolay Aleksandrov /* return true if anything changed, false otherwise */ 62f418af63SNikolay Aleksandrov static bool __vlan_add_flags(struct net_bridge_vlan *v, u16 flags) 6335e03f3aSVlad Yasevich { 6477751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 65f418af63SNikolay Aleksandrov u16 old_flags = v->flags; 66f418af63SNikolay Aleksandrov bool ret; 6777751ee8SNikolay Aleksandrov 682594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) 69907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 70635126b7SVlad Yasevich else 71907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 7277751ee8SNikolay Aleksandrov 7377751ee8SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_PVID) 74a580c76dSNikolay Aleksandrov ret = __vlan_add_pvid(vg, v); 752594e906SNikolay Aleksandrov else 76f418af63SNikolay Aleksandrov ret = __vlan_delete_pvid(vg, v->vid); 7735e03f3aSVlad Yasevich 7835e03f3aSVlad Yasevich if (flags & BRIDGE_VLAN_INFO_UNTAGGED) 792594e906SNikolay Aleksandrov v->flags |= BRIDGE_VLAN_INFO_UNTAGGED; 80635126b7SVlad Yasevich else 812594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_UNTAGGED; 82f418af63SNikolay Aleksandrov 83f418af63SNikolay Aleksandrov return ret || !!(old_flags ^ v->flags); 8435e03f3aSVlad Yasevich } 8535e03f3aSVlad Yasevich 867f109539SScott Feldman static int __vlan_vid_add(struct net_device *dev, struct net_bridge *br, 8727973793SIdo Schimmel struct net_bridge_vlan *v, u16 flags, 8827973793SIdo Schimmel struct netlink_ext_ack *extack) 897f109539SScott Feldman { 900944d6b5SJiri Pirko int err; 917f109539SScott Feldman 920944d6b5SJiri Pirko /* Try switchdev op first. In case it is not supported, fallback to 930944d6b5SJiri Pirko * 8021q add. 940944d6b5SJiri Pirko */ 9527973793SIdo Schimmel err = br_switchdev_port_vlan_add(dev, v->vid, flags, extack); 967f109539SScott Feldman if (err == -EOPNOTSUPP) 9727973793SIdo Schimmel return vlan_vid_add(dev, br->vlan_proto, v->vid); 9827973793SIdo Schimmel v->priv_flags |= BR_VLFLAG_ADDED_BY_SWITCHDEV; 997f109539SScott Feldman return err; 1007f109539SScott Feldman } 1017f109539SScott Feldman 1022594e906SNikolay Aleksandrov static void __vlan_add_list(struct net_bridge_vlan *v) 103243a2e63SVlad Yasevich { 104907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 1052594e906SNikolay Aleksandrov struct list_head *headp, *hpos; 1062594e906SNikolay Aleksandrov struct net_bridge_vlan *vent; 107243a2e63SVlad Yasevich 108907b1e6eSNikolay Aleksandrov if (br_vlan_is_master(v)) 109907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 110907b1e6eSNikolay Aleksandrov else 111907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 112907b1e6eSNikolay Aleksandrov 113907b1e6eSNikolay Aleksandrov headp = &vg->vlan_list; 1142594e906SNikolay Aleksandrov list_for_each_prev(hpos, headp) { 1152594e906SNikolay Aleksandrov vent = list_entry(hpos, struct net_bridge_vlan, vlist); 116*040c1257SColin Ian King if (v->vid >= vent->vid) 1172594e906SNikolay Aleksandrov break; 1182594e906SNikolay Aleksandrov } 119586c2b57SNikolay Aleksandrov list_add_rcu(&v->vlist, hpos); 120552406c4SVlad Yasevich } 121243a2e63SVlad Yasevich 1222594e906SNikolay Aleksandrov static void __vlan_del_list(struct net_bridge_vlan *v) 1232594e906SNikolay Aleksandrov { 124586c2b57SNikolay Aleksandrov list_del_rcu(&v->vlist); 125243a2e63SVlad Yasevich } 126243a2e63SVlad Yasevich 127bf361ad3SVivien Didelot static int __vlan_vid_del(struct net_device *dev, struct net_bridge *br, 12827973793SIdo Schimmel const struct net_bridge_vlan *v) 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 */ 13527973793SIdo Schimmel err = br_switchdev_port_vlan_del(dev, v->vid); 13627973793SIdo Schimmel if (!(v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV)) 13727973793SIdo Schimmel vlan_vid_del(dev, br->vlan_proto, v->vid); 13827973793SIdo Schimmel return err == -EOPNOTSUPP ? 0 : err; 1397f109539SScott Feldman } 1407f109539SScott Feldman 1414bbd026cSRandy Dunlap /* Returns a master vlan, if it didn't exist it gets created. In all cases 142f8ed289fSNikolay Aleksandrov * a reference is taken to the master vlan before returning. 143f8ed289fSNikolay Aleksandrov */ 144169327d5SPetr Machata static struct net_bridge_vlan * 145169327d5SPetr Machata br_vlan_get_master(struct net_bridge *br, u16 vid, 146169327d5SPetr Machata struct netlink_ext_ack *extack) 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) { 154f418af63SNikolay Aleksandrov bool changed; 155f418af63SNikolay Aleksandrov 156f8ed289fSNikolay Aleksandrov /* missing global ctx, create it now */ 157169327d5SPetr Machata if (br_vlan_add(br, vid, 0, &changed, extack)) 158f8ed289fSNikolay Aleksandrov return NULL; 159907b1e6eSNikolay Aleksandrov masterv = br_vlan_find(vg, vid); 160f8ed289fSNikolay Aleksandrov if (WARN_ON(!masterv)) 161f8ed289fSNikolay Aleksandrov return NULL; 1620e5a82efSIdo Schimmel refcount_set(&masterv->refcnt, 1); 1630e5a82efSIdo Schimmel return masterv; 164f8ed289fSNikolay Aleksandrov } 16525127759SReshetova, Elena refcount_inc(&masterv->refcnt); 166f8ed289fSNikolay Aleksandrov 167f8ed289fSNikolay Aleksandrov return masterv; 168f8ed289fSNikolay Aleksandrov } 169f8ed289fSNikolay Aleksandrov 1706dada9b1SNikolay Aleksandrov static void br_master_vlan_rcu_free(struct rcu_head *rcu) 1716dada9b1SNikolay Aleksandrov { 1726dada9b1SNikolay Aleksandrov struct net_bridge_vlan *v; 1736dada9b1SNikolay Aleksandrov 1746dada9b1SNikolay Aleksandrov v = container_of(rcu, struct net_bridge_vlan, rcu); 1756dada9b1SNikolay Aleksandrov WARN_ON(!br_vlan_is_master(v)); 1766dada9b1SNikolay Aleksandrov free_percpu(v->stats); 1776dada9b1SNikolay Aleksandrov v->stats = NULL; 1786dada9b1SNikolay Aleksandrov kfree(v); 1796dada9b1SNikolay Aleksandrov } 1806dada9b1SNikolay Aleksandrov 181f8ed289fSNikolay Aleksandrov static void br_vlan_put_master(struct net_bridge_vlan *masterv) 182f8ed289fSNikolay Aleksandrov { 183907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 184907b1e6eSNikolay Aleksandrov 185f8ed289fSNikolay Aleksandrov if (!br_vlan_is_master(masterv)) 186f8ed289fSNikolay Aleksandrov return; 187f8ed289fSNikolay Aleksandrov 188907b1e6eSNikolay Aleksandrov vg = br_vlan_group(masterv->br); 18925127759SReshetova, Elena if (refcount_dec_and_test(&masterv->refcnt)) { 190907b1e6eSNikolay Aleksandrov rhashtable_remove_fast(&vg->vlan_hash, 191f8ed289fSNikolay Aleksandrov &masterv->vnode, br_vlan_rht_params); 192f8ed289fSNikolay Aleksandrov __vlan_del_list(masterv); 1936dada9b1SNikolay Aleksandrov call_rcu(&masterv->rcu, br_master_vlan_rcu_free); 194f8ed289fSNikolay Aleksandrov } 195f8ed289fSNikolay Aleksandrov } 196f8ed289fSNikolay Aleksandrov 1979163a0fcSNikolay Aleksandrov static void nbp_vlan_rcu_free(struct rcu_head *rcu) 1989163a0fcSNikolay Aleksandrov { 1999163a0fcSNikolay Aleksandrov struct net_bridge_vlan *v; 2009163a0fcSNikolay Aleksandrov 2019163a0fcSNikolay Aleksandrov v = container_of(rcu, struct net_bridge_vlan, rcu); 2029163a0fcSNikolay Aleksandrov WARN_ON(br_vlan_is_master(v)); 2039163a0fcSNikolay Aleksandrov /* if we had per-port stats configured then free them here */ 2049d332e69SNikolay Aleksandrov if (v->priv_flags & BR_VLFLAG_PER_PORT_STATS) 2059163a0fcSNikolay Aleksandrov free_percpu(v->stats); 2069163a0fcSNikolay Aleksandrov v->stats = NULL; 2079163a0fcSNikolay Aleksandrov kfree(v); 2089163a0fcSNikolay Aleksandrov } 2099163a0fcSNikolay Aleksandrov 2102594e906SNikolay Aleksandrov /* This is the shared VLAN add function which works for both ports and bridge 2112594e906SNikolay Aleksandrov * devices. There are four possible calls to this function in terms of the 2122594e906SNikolay Aleksandrov * vlan entry type: 2132594e906SNikolay Aleksandrov * 1. vlan is being added on a port (no master flags, global entry exists) 214ddd611d3SIdo Schimmel * 2. vlan is being added on a bridge (both master and brentry flags) 2152594e906SNikolay Aleksandrov * 3. vlan is being added on a port, but a global entry didn't exist which 216ddd611d3SIdo Schimmel * is being created right now (master flag set, brentry flag unset), the 2172594e906SNikolay Aleksandrov * global entry is used for global per-vlan features, but not for filtering 218ddd611d3SIdo Schimmel * 4. same as 3 but with both master and brentry flags set so the entry 2192594e906SNikolay Aleksandrov * will be used for filtering in both the port and the bridge 2202594e906SNikolay Aleksandrov */ 221169327d5SPetr Machata static int __vlan_add(struct net_bridge_vlan *v, u16 flags, 222169327d5SPetr Machata struct netlink_ext_ack *extack) 223243a2e63SVlad Yasevich { 2242594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = NULL; 2252594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 2266be144f6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 2272594e906SNikolay Aleksandrov struct net_device *dev; 2282594e906SNikolay Aleksandrov struct net_bridge *br; 229bf361ad3SVivien Didelot int err; 230bf361ad3SVivien Didelot 2312594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 2322594e906SNikolay Aleksandrov br = v->br; 2332594e906SNikolay Aleksandrov dev = br->dev; 234907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 2352594e906SNikolay Aleksandrov } else { 2362594e906SNikolay Aleksandrov p = v->port; 2372594e906SNikolay Aleksandrov br = p->br; 2382594e906SNikolay Aleksandrov dev = p->dev; 239907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 2402594e906SNikolay Aleksandrov } 2412594e906SNikolay Aleksandrov 2422594e906SNikolay Aleksandrov if (p) { 2432594e906SNikolay Aleksandrov /* Add VLAN to the device filter if it is supported. 2442594e906SNikolay Aleksandrov * This ensures tagged traffic enters the bridge when 2452594e906SNikolay Aleksandrov * promiscuous mode is disabled by br_manage_promisc(). 2462594e906SNikolay Aleksandrov */ 24727973793SIdo Schimmel err = __vlan_vid_add(dev, br, v, flags, extack); 248bf361ad3SVivien Didelot if (err) 2492594e906SNikolay Aleksandrov goto out; 2502594e906SNikolay Aleksandrov 2512594e906SNikolay Aleksandrov /* need to work on the master vlan too */ 2522594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_MASTER) { 253f418af63SNikolay Aleksandrov bool changed; 254f418af63SNikolay Aleksandrov 255f418af63SNikolay Aleksandrov err = br_vlan_add(br, v->vid, 256f418af63SNikolay Aleksandrov flags | BRIDGE_VLAN_INFO_BRENTRY, 257169327d5SPetr Machata &changed, extack); 2582594e906SNikolay Aleksandrov if (err) 2592594e906SNikolay Aleksandrov goto out_filt; 260f545923bSNikolay Aleksandrov 261f545923bSNikolay Aleksandrov if (changed) 262f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, v->vid, 0, 263f545923bSNikolay Aleksandrov RTM_NEWVLAN); 2642594e906SNikolay Aleksandrov } 2652594e906SNikolay Aleksandrov 266169327d5SPetr Machata masterv = br_vlan_get_master(br, v->vid, extack); 267ee4f52a8SZhang Changzhong if (!masterv) { 268ee4f52a8SZhang Changzhong err = -ENOMEM; 2692594e906SNikolay Aleksandrov goto out_filt; 270ee4f52a8SZhang Changzhong } 2712594e906SNikolay Aleksandrov v->brvlan = masterv; 2729163a0fcSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_PER_PORT)) { 273281cc284SHeiner Kallweit v->stats = 274281cc284SHeiner Kallweit netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); 2759163a0fcSNikolay Aleksandrov if (!v->stats) { 2769163a0fcSNikolay Aleksandrov err = -ENOMEM; 2779163a0fcSNikolay Aleksandrov goto out_filt; 2789163a0fcSNikolay Aleksandrov } 2799d332e69SNikolay Aleksandrov v->priv_flags |= BR_VLFLAG_PER_PORT_STATS; 2809163a0fcSNikolay Aleksandrov } else { 2816dada9b1SNikolay Aleksandrov v->stats = masterv->stats; 2829163a0fcSNikolay Aleksandrov } 2839c86ce2cSPetr Machata } else { 284169327d5SPetr Machata err = br_switchdev_port_vlan_add(dev, v->vid, flags, extack); 2859c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 2869c86ce2cSPetr Machata goto out; 2872594e906SNikolay Aleksandrov } 2882594e906SNikolay Aleksandrov 2896be144f6SNikolay Aleksandrov /* Add the dev mac and count the vlan only if it's usable */ 2902594e906SNikolay Aleksandrov if (br_vlan_should_use(v)) { 2912594e906SNikolay Aleksandrov err = br_fdb_insert(br, p, dev->dev_addr, v->vid); 2922594e906SNikolay Aleksandrov if (err) { 2932594e906SNikolay Aleksandrov br_err(br, "failed insert local address into bridge forwarding table\n"); 2942594e906SNikolay Aleksandrov goto out_filt; 2952594e906SNikolay Aleksandrov } 2966be144f6SNikolay Aleksandrov vg->num_vlans++; 2972594e906SNikolay Aleksandrov } 2982594e906SNikolay Aleksandrov 299a580c76dSNikolay Aleksandrov /* set the state before publishing */ 300a580c76dSNikolay Aleksandrov v->state = BR_STATE_FORWARDING; 301a580c76dSNikolay Aleksandrov 3026be144f6SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&vg->vlan_hash, &v->vnode, 3036be144f6SNikolay Aleksandrov br_vlan_rht_params); 3042594e906SNikolay Aleksandrov if (err) 3052594e906SNikolay Aleksandrov goto out_fdb_insert; 3062594e906SNikolay Aleksandrov 3072594e906SNikolay Aleksandrov __vlan_add_list(v); 3082594e906SNikolay Aleksandrov __vlan_add_flags(v, flags); 30980900acdSMike Manning 31080900acdSMike Manning if (p) 31180900acdSMike Manning nbp_vlan_set_vlan_dev_state(p, v->vid); 3122594e906SNikolay Aleksandrov out: 3132594e906SNikolay Aleksandrov return err; 3142594e906SNikolay Aleksandrov 3152594e906SNikolay Aleksandrov out_fdb_insert: 3166be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 3176be144f6SNikolay Aleksandrov br_fdb_find_delete_local(br, p, dev->dev_addr, v->vid); 3186be144f6SNikolay Aleksandrov vg->num_vlans--; 3196be144f6SNikolay Aleksandrov } 3202594e906SNikolay Aleksandrov 3212594e906SNikolay Aleksandrov out_filt: 3222594e906SNikolay Aleksandrov if (p) { 32327973793SIdo Schimmel __vlan_vid_del(dev, br, v); 3242594e906SNikolay Aleksandrov if (masterv) { 3251a3aea25SLi RongQing if (v->stats && masterv->stats != v->stats) 3261a3aea25SLi RongQing free_percpu(v->stats); 3271a3aea25SLi RongQing v->stats = NULL; 3281a3aea25SLi RongQing 329f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 3302594e906SNikolay Aleksandrov v->brvlan = NULL; 3312594e906SNikolay Aleksandrov } 3329c86ce2cSPetr Machata } else { 3339c86ce2cSPetr Machata br_switchdev_port_vlan_del(dev, v->vid); 3342594e906SNikolay Aleksandrov } 3352594e906SNikolay Aleksandrov 3362594e906SNikolay Aleksandrov goto out; 3372594e906SNikolay Aleksandrov } 3382594e906SNikolay Aleksandrov 3392594e906SNikolay Aleksandrov static int __vlan_del(struct net_bridge_vlan *v) 3402594e906SNikolay Aleksandrov { 3412594e906SNikolay Aleksandrov struct net_bridge_vlan *masterv = v; 34277751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 3432594e906SNikolay Aleksandrov struct net_bridge_port *p = NULL; 3442594e906SNikolay Aleksandrov int err = 0; 3452594e906SNikolay Aleksandrov 3462594e906SNikolay Aleksandrov if (br_vlan_is_master(v)) { 347907b1e6eSNikolay Aleksandrov vg = br_vlan_group(v->br); 3482594e906SNikolay Aleksandrov } else { 3492594e906SNikolay Aleksandrov p = v->port; 350907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(v->port); 3512594e906SNikolay Aleksandrov masterv = v->brvlan; 3522594e906SNikolay Aleksandrov } 3532594e906SNikolay Aleksandrov 35477751ee8SNikolay Aleksandrov __vlan_delete_pvid(vg, v->vid); 3552594e906SNikolay Aleksandrov if (p) { 35627973793SIdo Schimmel err = __vlan_vid_del(p->dev, p->br, v); 3572594e906SNikolay Aleksandrov if (err) 3582594e906SNikolay Aleksandrov goto out; 3599c86ce2cSPetr Machata } else { 3609c86ce2cSPetr Machata err = br_switchdev_port_vlan_del(v->br->dev, v->vid); 3619c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 3629c86ce2cSPetr Machata goto out; 3639c86ce2cSPetr Machata err = 0; 3642594e906SNikolay Aleksandrov } 3652594e906SNikolay Aleksandrov 3666be144f6SNikolay Aleksandrov if (br_vlan_should_use(v)) { 3672594e906SNikolay Aleksandrov v->flags &= ~BRIDGE_VLAN_INFO_BRENTRY; 3686be144f6SNikolay Aleksandrov vg->num_vlans--; 3692594e906SNikolay Aleksandrov } 3702594e906SNikolay Aleksandrov 3712594e906SNikolay Aleksandrov if (masterv != v) { 372efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 37377751ee8SNikolay Aleksandrov rhashtable_remove_fast(&vg->vlan_hash, &v->vnode, 37477751ee8SNikolay Aleksandrov br_vlan_rht_params); 3752594e906SNikolay Aleksandrov __vlan_del_list(v); 37680900acdSMike Manning nbp_vlan_set_vlan_dev_state(p, v->vid); 3779163a0fcSNikolay Aleksandrov call_rcu(&v->rcu, nbp_vlan_rcu_free); 3782594e906SNikolay Aleksandrov } 3792594e906SNikolay Aleksandrov 380f8ed289fSNikolay Aleksandrov br_vlan_put_master(masterv); 3812594e906SNikolay Aleksandrov out: 382bf361ad3SVivien Didelot return err; 3838580e211SToshiaki Makita } 384243a2e63SVlad Yasevich 385f409d0edSNikolay Aleksandrov static void __vlan_group_free(struct net_bridge_vlan_group *vg) 386f409d0edSNikolay Aleksandrov { 387f409d0edSNikolay Aleksandrov WARN_ON(!list_empty(&vg->vlan_list)); 388f409d0edSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 389efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 390f409d0edSNikolay Aleksandrov kfree(vg); 391f409d0edSNikolay Aleksandrov } 392f409d0edSNikolay Aleksandrov 393f545923bSNikolay Aleksandrov static void __vlan_flush(const struct net_bridge *br, 394f545923bSNikolay Aleksandrov const struct net_bridge_port *p, 395f545923bSNikolay Aleksandrov struct net_bridge_vlan_group *vg) 396243a2e63SVlad Yasevich { 3972594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan, *tmp; 398f545923bSNikolay Aleksandrov u16 v_start = 0, v_end = 0; 3992594e906SNikolay Aleksandrov 400f409d0edSNikolay Aleksandrov __vlan_delete_pvid(vg, vg->pvid); 401f545923bSNikolay Aleksandrov list_for_each_entry_safe(vlan, tmp, &vg->vlan_list, vlist) { 402f545923bSNikolay Aleksandrov /* take care of disjoint ranges */ 403f545923bSNikolay Aleksandrov if (!v_start) { 404f545923bSNikolay Aleksandrov v_start = vlan->vid; 405f545923bSNikolay Aleksandrov } else if (vlan->vid - v_end != 1) { 406f545923bSNikolay Aleksandrov /* found range end, notify and start next one */ 407f545923bSNikolay Aleksandrov br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN); 408f545923bSNikolay Aleksandrov v_start = vlan->vid; 409f545923bSNikolay Aleksandrov } 410f545923bSNikolay Aleksandrov v_end = vlan->vid; 411f545923bSNikolay Aleksandrov 4122594e906SNikolay Aleksandrov __vlan_del(vlan); 413243a2e63SVlad Yasevich } 414243a2e63SVlad Yasevich 415f545923bSNikolay Aleksandrov /* notify about the last/whole vlan range */ 416f545923bSNikolay Aleksandrov if (v_start) 417f545923bSNikolay Aleksandrov br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN); 418f545923bSNikolay Aleksandrov } 419f545923bSNikolay Aleksandrov 42078851988SVlad Yasevich struct sk_buff *br_handle_vlan(struct net_bridge *br, 42111538d03SRoopa Prabhu const struct net_bridge_port *p, 4222594e906SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 423a37b85c9SVlad Yasevich struct sk_buff *skb) 424a37b85c9SVlad Yasevich { 425281cc284SHeiner Kallweit struct pcpu_sw_netstats *stats; 4262594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 427a37b85c9SVlad Yasevich u16 vid; 428a37b85c9SVlad Yasevich 42920adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 43020adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 43178851988SVlad Yasevich goto out; 43278851988SVlad Yasevich 4332594e906SNikolay Aleksandrov /* At this point, we know that the frame was filtered and contains 4342594e906SNikolay Aleksandrov * a valid vlan id. If the vlan id has untagged flag set, 4352594e906SNikolay Aleksandrov * send untagged; otherwise, send tagged. 4362594e906SNikolay Aleksandrov */ 4372594e906SNikolay Aleksandrov br_vlan_get_tag(skb, &vid); 4382594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 4392594e906SNikolay Aleksandrov /* Vlan entry must be configured at this point. The 440fc92f745SVlad Yasevich * only exception is the bridge is set in promisc mode and the 441fc92f745SVlad Yasevich * packet is destined for the bridge device. In this case 442fc92f745SVlad Yasevich * pass the packet as is. 443fc92f745SVlad Yasevich */ 4442594e906SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) { 445fc92f745SVlad Yasevich if ((br->dev->flags & IFF_PROMISC) && skb->dev == br->dev) { 446fc92f745SVlad Yasevich goto out; 447fc92f745SVlad Yasevich } else { 448fc92f745SVlad Yasevich kfree_skb(skb); 449fc92f745SVlad Yasevich return NULL; 450fc92f745SVlad Yasevich } 451fc92f745SVlad Yasevich } 452ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { 4536dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 4546dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 4556dada9b1SNikolay Aleksandrov stats->tx_bytes += skb->len; 4566dada9b1SNikolay Aleksandrov stats->tx_packets++; 4576dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 4586dada9b1SNikolay Aleksandrov } 4596dada9b1SNikolay Aleksandrov 4602594e906SNikolay Aleksandrov if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED) 4615978f8a9SMichał Mirosław __vlan_hwaccel_clear_tag(skb); 46211538d03SRoopa Prabhu 46311538d03SRoopa Prabhu if (p && (p->flags & BR_VLAN_TUNNEL) && 46411538d03SRoopa Prabhu br_handle_egress_vlan_tunnel(skb, v)) { 46511538d03SRoopa Prabhu kfree_skb(skb); 46611538d03SRoopa Prabhu return NULL; 46711538d03SRoopa Prabhu } 46878851988SVlad Yasevich out: 46978851988SVlad Yasevich return skb; 47078851988SVlad Yasevich } 47178851988SVlad Yasevich 47278851988SVlad Yasevich /* Called under RCU */ 4736dada9b1SNikolay Aleksandrov static bool __allowed_ingress(const struct net_bridge *br, 4746dada9b1SNikolay Aleksandrov struct net_bridge_vlan_group *vg, 475a580c76dSNikolay Aleksandrov struct sk_buff *skb, u16 *vid, 476a580c76dSNikolay Aleksandrov u8 *state) 47778851988SVlad Yasevich { 478281cc284SHeiner Kallweit struct pcpu_sw_netstats *stats; 4796dada9b1SNikolay Aleksandrov struct net_bridge_vlan *v; 4808580e211SToshiaki Makita bool tagged; 481a37b85c9SVlad Yasevich 48220adfa1aSVlad Yasevich BR_INPUT_SKB_CB(skb)->vlan_filtered = true; 48312464bb8SToshiaki Makita /* If vlan tx offload is disabled on bridge device and frame was 48412464bb8SToshiaki Makita * sent from vlan device on the bridge device, it does not have 48512464bb8SToshiaki Makita * HW accelerated vlan tag. 48612464bb8SToshiaki Makita */ 487df8a39deSJiri Pirko if (unlikely(!skb_vlan_tag_present(skb) && 4886dada9b1SNikolay Aleksandrov skb->protocol == br->vlan_proto)) { 4890d5501c1SVlad Yasevich skb = skb_vlan_untag(skb); 49012464bb8SToshiaki Makita if (unlikely(!skb)) 49112464bb8SToshiaki Makita return false; 49212464bb8SToshiaki Makita } 49312464bb8SToshiaki Makita 4948580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid)) { 4958580e211SToshiaki Makita /* Tagged frame */ 4966dada9b1SNikolay Aleksandrov if (skb->vlan_proto != br->vlan_proto) { 4978580e211SToshiaki Makita /* Protocol-mismatch, empty out vlan_tci for new tag */ 4988580e211SToshiaki Makita skb_push(skb, ETH_HLEN); 49962749e2cSJiri Pirko skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto, 500df8a39deSJiri Pirko skb_vlan_tag_get(skb)); 5018580e211SToshiaki Makita if (unlikely(!skb)) 5028580e211SToshiaki Makita return false; 5038580e211SToshiaki Makita 5048580e211SToshiaki Makita skb_pull(skb, ETH_HLEN); 5058580e211SToshiaki Makita skb_reset_mac_len(skb); 5068580e211SToshiaki Makita *vid = 0; 5078580e211SToshiaki Makita tagged = false; 5088580e211SToshiaki Makita } else { 5098580e211SToshiaki Makita tagged = true; 5108580e211SToshiaki Makita } 5118580e211SToshiaki Makita } else { 5128580e211SToshiaki Makita /* Untagged frame */ 5138580e211SToshiaki Makita tagged = false; 5148580e211SToshiaki Makita } 5158580e211SToshiaki Makita 516b90356ceSToshiaki Makita if (!*vid) { 51777751ee8SNikolay Aleksandrov u16 pvid = br_get_pvid(vg); 51877751ee8SNikolay Aleksandrov 519b90356ceSToshiaki Makita /* Frame had a tag with VID 0 or did not have a tag. 520b90356ceSToshiaki Makita * See if pvid is set on this port. That tells us which 521b90356ceSToshiaki Makita * vlan untagged or priority-tagged traffic belongs to. 52278851988SVlad Yasevich */ 5233df6bf45SVlad Yasevich if (!pvid) 524eb707618SToshiaki Makita goto drop; 52578851988SVlad Yasevich 526b90356ceSToshiaki Makita /* PVID is set on this port. Any untagged or priority-tagged 527b90356ceSToshiaki Makita * ingress frame is considered to belong to this vlan. 52878851988SVlad Yasevich */ 529dfb5fa32SToshiaki Makita *vid = pvid; 5308580e211SToshiaki Makita if (likely(!tagged)) 531b90356ceSToshiaki Makita /* Untagged Frame. */ 5326dada9b1SNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, br->vlan_proto, pvid); 533b90356ceSToshiaki Makita else 534b90356ceSToshiaki Makita /* Priority-tagged Frame. 5355978f8a9SMichał Mirosław * At this point, we know that skb->vlan_tci VID 5365978f8a9SMichał Mirosław * field was 0. 537b90356ceSToshiaki Makita * We update only VID field and preserve PCP field. 538b90356ceSToshiaki Makita */ 539b90356ceSToshiaki Makita skb->vlan_tci |= pvid; 540b90356ceSToshiaki Makita 5416dada9b1SNikolay Aleksandrov /* if stats are disabled we can avoid the lookup */ 542a580c76dSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { 543a580c76dSNikolay Aleksandrov if (*state == BR_STATE_FORWARDING) { 544a580c76dSNikolay Aleksandrov *state = br_vlan_get_pvid_state(vg); 545a580c76dSNikolay Aleksandrov return br_vlan_state_allowed(*state, true); 546a580c76dSNikolay Aleksandrov } else { 54778851988SVlad Yasevich return true; 54878851988SVlad Yasevich } 549a580c76dSNikolay Aleksandrov } 550a580c76dSNikolay Aleksandrov } 55177751ee8SNikolay Aleksandrov v = br_vlan_find(vg, *vid); 5526dada9b1SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) 5536dada9b1SNikolay Aleksandrov goto drop; 5546dada9b1SNikolay Aleksandrov 555a580c76dSNikolay Aleksandrov if (*state == BR_STATE_FORWARDING) { 556a580c76dSNikolay Aleksandrov *state = br_vlan_get_state(v); 557a580c76dSNikolay Aleksandrov if (!br_vlan_state_allowed(*state, true)) 558a580c76dSNikolay Aleksandrov goto drop; 559a580c76dSNikolay Aleksandrov } 560a580c76dSNikolay Aleksandrov 561ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { 5626dada9b1SNikolay Aleksandrov stats = this_cpu_ptr(v->stats); 5636dada9b1SNikolay Aleksandrov u64_stats_update_begin(&stats->syncp); 5646dada9b1SNikolay Aleksandrov stats->rx_bytes += skb->len; 5656dada9b1SNikolay Aleksandrov stats->rx_packets++; 5666dada9b1SNikolay Aleksandrov u64_stats_update_end(&stats->syncp); 5676dada9b1SNikolay Aleksandrov } 5686dada9b1SNikolay Aleksandrov 569a37b85c9SVlad Yasevich return true; 5706dada9b1SNikolay Aleksandrov 571eb707618SToshiaki Makita drop: 572eb707618SToshiaki Makita kfree_skb(skb); 573a37b85c9SVlad Yasevich return false; 574a37b85c9SVlad Yasevich } 575a37b85c9SVlad Yasevich 57677751ee8SNikolay Aleksandrov bool br_allowed_ingress(const struct net_bridge *br, 57777751ee8SNikolay Aleksandrov struct net_bridge_vlan_group *vg, struct sk_buff *skb, 578a580c76dSNikolay Aleksandrov u16 *vid, u8 *state) 5792594e906SNikolay Aleksandrov { 5802594e906SNikolay Aleksandrov /* If VLAN filtering is disabled on the bridge, all packets are 5812594e906SNikolay Aleksandrov * permitted. 5822594e906SNikolay Aleksandrov */ 583ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED)) { 5842594e906SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->vlan_filtered = false; 5852594e906SNikolay Aleksandrov return true; 5862594e906SNikolay Aleksandrov } 5872594e906SNikolay Aleksandrov 588a580c76dSNikolay Aleksandrov return __allowed_ingress(br, vg, skb, vid, state); 5892594e906SNikolay Aleksandrov } 5902594e906SNikolay Aleksandrov 59185f46c6bSVlad Yasevich /* Called under RCU. */ 5922594e906SNikolay Aleksandrov bool br_allowed_egress(struct net_bridge_vlan_group *vg, 59385f46c6bSVlad Yasevich const struct sk_buff *skb) 59485f46c6bSVlad Yasevich { 5952594e906SNikolay Aleksandrov const struct net_bridge_vlan *v; 59685f46c6bSVlad Yasevich u16 vid; 59785f46c6bSVlad Yasevich 59820adfa1aSVlad Yasevich /* If this packet was not filtered at input, let it pass */ 59920adfa1aSVlad Yasevich if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) 60085f46c6bSVlad Yasevich return true; 60185f46c6bSVlad Yasevich 60285f46c6bSVlad Yasevich br_vlan_get_tag(skb, &vid); 6032594e906SNikolay Aleksandrov v = br_vlan_find(vg, vid); 604a580c76dSNikolay Aleksandrov if (v && br_vlan_should_use(v) && 605a580c76dSNikolay Aleksandrov br_vlan_state_allowed(br_vlan_get_state(v), false)) 60685f46c6bSVlad Yasevich return true; 60785f46c6bSVlad Yasevich 60885f46c6bSVlad Yasevich return false; 60985f46c6bSVlad Yasevich } 61085f46c6bSVlad Yasevich 611e0d7968aSToshiaki Makita /* Called under RCU */ 612e0d7968aSToshiaki Makita bool br_should_learn(struct net_bridge_port *p, struct sk_buff *skb, u16 *vid) 613e0d7968aSToshiaki Makita { 614468e7944SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 615e0d7968aSToshiaki Makita struct net_bridge *br = p->br; 616a580c76dSNikolay Aleksandrov struct net_bridge_vlan *v; 617e0d7968aSToshiaki Makita 61820adfa1aSVlad Yasevich /* If filtering was disabled at input, let it pass. */ 619ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED)) 620e0d7968aSToshiaki Makita return true; 621e0d7968aSToshiaki Makita 622eca1e006SIdo Schimmel vg = nbp_vlan_group_rcu(p); 623468e7944SNikolay Aleksandrov if (!vg || !vg->num_vlans) 624e0d7968aSToshiaki Makita return false; 625e0d7968aSToshiaki Makita 6268580e211SToshiaki Makita if (!br_vlan_get_tag(skb, vid) && skb->vlan_proto != br->vlan_proto) 6278580e211SToshiaki Makita *vid = 0; 6288580e211SToshiaki Makita 629e0d7968aSToshiaki Makita if (!*vid) { 63077751ee8SNikolay Aleksandrov *vid = br_get_pvid(vg); 631a580c76dSNikolay Aleksandrov if (!*vid || 632a580c76dSNikolay Aleksandrov !br_vlan_state_allowed(br_vlan_get_pvid_state(vg), true)) 633e0d7968aSToshiaki Makita return false; 634e0d7968aSToshiaki Makita 635e0d7968aSToshiaki Makita return true; 636e0d7968aSToshiaki Makita } 637e0d7968aSToshiaki Makita 638a580c76dSNikolay Aleksandrov v = br_vlan_find(vg, *vid); 639a580c76dSNikolay Aleksandrov if (v && br_vlan_state_allowed(br_vlan_get_state(v), true)) 640e0d7968aSToshiaki Makita return true; 641e0d7968aSToshiaki Makita 642e0d7968aSToshiaki Makita return false; 643e0d7968aSToshiaki Makita } 644e0d7968aSToshiaki Makita 645dbd6dc75SPetr Machata static int br_vlan_add_existing(struct net_bridge *br, 646dbd6dc75SPetr Machata struct net_bridge_vlan_group *vg, 647dbd6dc75SPetr Machata struct net_bridge_vlan *vlan, 648169327d5SPetr Machata u16 flags, bool *changed, 649169327d5SPetr Machata struct netlink_ext_ack *extack) 650dbd6dc75SPetr Machata { 651dbd6dc75SPetr Machata int err; 652dbd6dc75SPetr Machata 653169327d5SPetr Machata err = br_switchdev_port_vlan_add(br->dev, vlan->vid, flags, extack); 6549c86ce2cSPetr Machata if (err && err != -EOPNOTSUPP) 6559c86ce2cSPetr Machata return err; 6569c86ce2cSPetr Machata 657dbd6dc75SPetr Machata if (!br_vlan_is_brentry(vlan)) { 658dbd6dc75SPetr Machata /* Trying to change flags of non-existent bridge vlan */ 6599c86ce2cSPetr Machata if (!(flags & BRIDGE_VLAN_INFO_BRENTRY)) { 6609c86ce2cSPetr Machata err = -EINVAL; 6619c86ce2cSPetr Machata goto err_flags; 6629c86ce2cSPetr Machata } 663dbd6dc75SPetr Machata /* It was only kept for port vlans, now make it real */ 664dbd6dc75SPetr Machata err = br_fdb_insert(br, NULL, br->dev->dev_addr, 665dbd6dc75SPetr Machata vlan->vid); 666dbd6dc75SPetr Machata if (err) { 667dbd6dc75SPetr Machata br_err(br, "failed to insert local address into bridge forwarding table\n"); 6689c86ce2cSPetr Machata goto err_fdb_insert; 669dbd6dc75SPetr Machata } 670dbd6dc75SPetr Machata 671dbd6dc75SPetr Machata refcount_inc(&vlan->refcnt); 672dbd6dc75SPetr Machata vlan->flags |= BRIDGE_VLAN_INFO_BRENTRY; 673dbd6dc75SPetr Machata vg->num_vlans++; 674dbd6dc75SPetr Machata *changed = true; 675dbd6dc75SPetr Machata } 676dbd6dc75SPetr Machata 677dbd6dc75SPetr Machata if (__vlan_add_flags(vlan, flags)) 678dbd6dc75SPetr Machata *changed = true; 679dbd6dc75SPetr Machata 680dbd6dc75SPetr Machata return 0; 6819c86ce2cSPetr Machata 6829c86ce2cSPetr Machata err_fdb_insert: 6839c86ce2cSPetr Machata err_flags: 6849c86ce2cSPetr Machata br_switchdev_port_vlan_del(br->dev, vlan->vid); 6859c86ce2cSPetr Machata return err; 686dbd6dc75SPetr Machata } 687dbd6dc75SPetr Machata 6888adff41cSToshiaki Makita /* Must be protected by RTNL. 6898adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 690f418af63SNikolay Aleksandrov * changed must be true only if the vlan was created or updated 6918adff41cSToshiaki Makita */ 692169327d5SPetr Machata int br_vlan_add(struct net_bridge *br, u16 vid, u16 flags, bool *changed, 693169327d5SPetr Machata struct netlink_ext_ack *extack) 694243a2e63SVlad Yasevich { 695907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 6962594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 6972594e906SNikolay Aleksandrov int ret; 698243a2e63SVlad Yasevich 699243a2e63SVlad Yasevich ASSERT_RTNL(); 700243a2e63SVlad Yasevich 701f418af63SNikolay Aleksandrov *changed = false; 702907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 703907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(vg, vid); 704dbd6dc75SPetr Machata if (vlan) 705169327d5SPetr Machata return br_vlan_add_existing(br, vg, vlan, flags, changed, 706169327d5SPetr Machata extack); 707243a2e63SVlad Yasevich 7082594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 7092594e906SNikolay Aleksandrov if (!vlan) 710243a2e63SVlad Yasevich return -ENOMEM; 711243a2e63SVlad Yasevich 712281cc284SHeiner Kallweit vlan->stats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); 7136dada9b1SNikolay Aleksandrov if (!vlan->stats) { 7146dada9b1SNikolay Aleksandrov kfree(vlan); 7156dada9b1SNikolay Aleksandrov return -ENOMEM; 7166dada9b1SNikolay Aleksandrov } 7172594e906SNikolay Aleksandrov vlan->vid = vid; 7182594e906SNikolay Aleksandrov vlan->flags = flags | BRIDGE_VLAN_INFO_MASTER; 7192594e906SNikolay Aleksandrov vlan->flags &= ~BRIDGE_VLAN_INFO_PVID; 7202594e906SNikolay Aleksandrov vlan->br = br; 7212594e906SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_BRENTRY) 72225127759SReshetova, Elena refcount_set(&vlan->refcnt, 1); 723169327d5SPetr Machata ret = __vlan_add(vlan, flags, extack); 7246dada9b1SNikolay Aleksandrov if (ret) { 7256dada9b1SNikolay Aleksandrov free_percpu(vlan->stats); 7262594e906SNikolay Aleksandrov kfree(vlan); 727f418af63SNikolay Aleksandrov } else { 728f418af63SNikolay Aleksandrov *changed = true; 7296dada9b1SNikolay Aleksandrov } 730243a2e63SVlad Yasevich 7312594e906SNikolay Aleksandrov return ret; 732243a2e63SVlad Yasevich } 733243a2e63SVlad Yasevich 7348adff41cSToshiaki Makita /* Must be protected by RTNL. 7358adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 7368adff41cSToshiaki Makita */ 737243a2e63SVlad Yasevich int br_vlan_delete(struct net_bridge *br, u16 vid) 738243a2e63SVlad Yasevich { 739907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 7402594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 741243a2e63SVlad Yasevich 742243a2e63SVlad Yasevich ASSERT_RTNL(); 743243a2e63SVlad Yasevich 744907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 745907b1e6eSNikolay Aleksandrov v = br_vlan_find(vg, vid); 7462594e906SNikolay Aleksandrov if (!v || !br_vlan_is_brentry(v)) 7472594e906SNikolay Aleksandrov return -ENOENT; 748243a2e63SVlad Yasevich 749424bb9c9SToshiaki Makita br_fdb_find_delete_local(br, NULL, br->dev->dev_addr, vid); 7503741873bSRoopa Prabhu br_fdb_delete_by_port(br, NULL, vid, 0); 751bc9a25d2SVlad Yasevich 752efa5356bSRoopa Prabhu vlan_tunnel_info_del(vg, v); 753efa5356bSRoopa Prabhu 7542594e906SNikolay Aleksandrov return __vlan_del(v); 755243a2e63SVlad Yasevich } 756243a2e63SVlad Yasevich 757243a2e63SVlad Yasevich void br_vlan_flush(struct net_bridge *br) 758243a2e63SVlad Yasevich { 759f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 760f409d0edSNikolay Aleksandrov 761243a2e63SVlad Yasevich ASSERT_RTNL(); 762243a2e63SVlad Yasevich 763f409d0edSNikolay Aleksandrov vg = br_vlan_group(br); 764f545923bSNikolay Aleksandrov __vlan_flush(br, NULL, vg); 765f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(br->vlgrp, NULL); 766f409d0edSNikolay Aleksandrov synchronize_rcu(); 767f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 768243a2e63SVlad Yasevich } 769243a2e63SVlad Yasevich 7702594e906SNikolay Aleksandrov struct net_bridge_vlan *br_vlan_find(struct net_bridge_vlan_group *vg, u16 vid) 7712b292fb4SToshiaki Makita { 7722594e906SNikolay Aleksandrov if (!vg) 7732594e906SNikolay Aleksandrov return NULL; 7742b292fb4SToshiaki Makita 7752594e906SNikolay Aleksandrov return br_vlan_lookup(&vg->vlan_hash, vid); 7762b292fb4SToshiaki Makita } 7772b292fb4SToshiaki Makita 778204177f3SToshiaki Makita /* Must be protected by RTNL. */ 779204177f3SToshiaki Makita static void recalculate_group_addr(struct net_bridge *br) 780204177f3SToshiaki Makita { 781be3664a0SNikolay Aleksandrov if (br_opt_get(br, BROPT_GROUP_ADDR_SET)) 782204177f3SToshiaki Makita return; 783204177f3SToshiaki Makita 784204177f3SToshiaki Makita spin_lock_bh(&br->lock); 785ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED) || 786ae75767eSNikolay Aleksandrov br->vlan_proto == htons(ETH_P_8021Q)) { 787204177f3SToshiaki Makita /* Bridge Group Address */ 788204177f3SToshiaki Makita br->group_addr[5] = 0x00; 789204177f3SToshiaki Makita } else { /* vlan_enabled && ETH_P_8021AD */ 790204177f3SToshiaki Makita /* Provider Bridge Group Address */ 791204177f3SToshiaki Makita br->group_addr[5] = 0x08; 792204177f3SToshiaki Makita } 793204177f3SToshiaki Makita spin_unlock_bh(&br->lock); 794204177f3SToshiaki Makita } 795204177f3SToshiaki Makita 796204177f3SToshiaki Makita /* Must be protected by RTNL. */ 797204177f3SToshiaki Makita void br_recalculate_fwd_mask(struct net_bridge *br) 798204177f3SToshiaki Makita { 799ae75767eSNikolay Aleksandrov if (!br_opt_get(br, BROPT_VLAN_ENABLED) || 800ae75767eSNikolay Aleksandrov br->vlan_proto == htons(ETH_P_8021Q)) 801204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_DEFAULT; 802204177f3SToshiaki Makita else /* vlan_enabled && ETH_P_8021AD */ 803204177f3SToshiaki Makita br->group_fwd_mask_required = BR_GROUPFWD_8021AD & 804204177f3SToshiaki Makita ~(1u << br->group_addr[5]); 805204177f3SToshiaki Makita } 806204177f3SToshiaki Makita 8079e781401SVladimir Oltean int br_vlan_filter_toggle(struct net_bridge *br, unsigned long val, 8089e781401SVladimir Oltean struct netlink_ext_ack *extack) 809243a2e63SVlad Yasevich { 8106b72a770SElad Raz struct switchdev_attr attr = { 8116b72a770SElad Raz .orig_dev = br->dev, 8126b72a770SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 8136b72a770SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 8146b72a770SElad Raz .u.vlan_filtering = val, 8156b72a770SElad Raz }; 8166b72a770SElad Raz int err; 8176b72a770SElad Raz 818ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_ENABLED) == !!val) 819a7854037SNikolay Aleksandrov return 0; 820243a2e63SVlad Yasevich 821dcbdf135SVladimir Oltean err = switchdev_port_attr_set(br->dev, &attr, extack); 8226b72a770SElad Raz if (err && err != -EOPNOTSUPP) 8236b72a770SElad Raz return err; 8246b72a770SElad Raz 825ae75767eSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_ENABLED, !!val); 8262796d0c6SVlad Yasevich br_manage_promisc(br); 827204177f3SToshiaki Makita recalculate_group_addr(br); 828204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 829243a2e63SVlad Yasevich 830a7854037SNikolay Aleksandrov return 0; 831a7854037SNikolay Aleksandrov } 832a7854037SNikolay Aleksandrov 8331f51445aSIdo Schimmel bool br_vlan_enabled(const struct net_device *dev) 8341f51445aSIdo Schimmel { 8351f51445aSIdo Schimmel struct net_bridge *br = netdev_priv(dev); 8361f51445aSIdo Schimmel 837ae75767eSNikolay Aleksandrov return br_opt_get(br, BROPT_VLAN_ENABLED); 8381f51445aSIdo Schimmel } 8391f51445aSIdo Schimmel EXPORT_SYMBOL_GPL(br_vlan_enabled); 8401f51445aSIdo Schimmel 84131aed46fSwenxu int br_vlan_get_proto(const struct net_device *dev, u16 *p_proto) 84231aed46fSwenxu { 84331aed46fSwenxu struct net_bridge *br = netdev_priv(dev); 84431aed46fSwenxu 84531aed46fSwenxu *p_proto = ntohs(br->vlan_proto); 84631aed46fSwenxu 84731aed46fSwenxu return 0; 84831aed46fSwenxu } 84931aed46fSwenxu EXPORT_SYMBOL_GPL(br_vlan_get_proto); 85031aed46fSwenxu 851dcbdf135SVladimir Oltean int __br_vlan_set_proto(struct net_bridge *br, __be16 proto, 852dcbdf135SVladimir Oltean struct netlink_ext_ack *extack) 853204177f3SToshiaki Makita { 85422ec19f3SDanielle Ratson struct switchdev_attr attr = { 85522ec19f3SDanielle Ratson .orig_dev = br->dev, 85622ec19f3SDanielle Ratson .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_PROTOCOL, 85722ec19f3SDanielle Ratson .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 85822ec19f3SDanielle Ratson .u.vlan_protocol = ntohs(proto), 85922ec19f3SDanielle Ratson }; 860204177f3SToshiaki Makita int err = 0; 861204177f3SToshiaki Makita struct net_bridge_port *p; 8622594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 863907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 86422ec19f3SDanielle Ratson __be16 oldproto = br->vlan_proto; 865204177f3SToshiaki Makita 866204177f3SToshiaki Makita if (br->vlan_proto == proto) 867d2d427b3SToshiaki Makita return 0; 868204177f3SToshiaki Makita 869dcbdf135SVladimir Oltean err = switchdev_port_attr_set(br->dev, &attr, extack); 87022ec19f3SDanielle Ratson if (err && err != -EOPNOTSUPP) 87122ec19f3SDanielle Ratson return err; 87222ec19f3SDanielle Ratson 873204177f3SToshiaki Makita /* Add VLANs for the new proto to the device filter. */ 874204177f3SToshiaki Makita list_for_each_entry(p, &br->port_list, list) { 875907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 876907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 8772594e906SNikolay Aleksandrov err = vlan_vid_add(p->dev, proto, vlan->vid); 878204177f3SToshiaki Makita if (err) 879204177f3SToshiaki Makita goto err_filt; 880204177f3SToshiaki Makita } 881204177f3SToshiaki Makita } 882204177f3SToshiaki Makita 883204177f3SToshiaki Makita br->vlan_proto = proto; 884204177f3SToshiaki Makita 885204177f3SToshiaki Makita recalculate_group_addr(br); 886204177f3SToshiaki Makita br_recalculate_fwd_mask(br); 887204177f3SToshiaki Makita 888204177f3SToshiaki Makita /* Delete VLANs for the old proto from the device filter. */ 889907b1e6eSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 890907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 891907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 8922594e906SNikolay Aleksandrov vlan_vid_del(p->dev, oldproto, vlan->vid); 893907b1e6eSNikolay Aleksandrov } 894204177f3SToshiaki Makita 895d2d427b3SToshiaki Makita return 0; 896204177f3SToshiaki Makita 897204177f3SToshiaki Makita err_filt: 89822ec19f3SDanielle Ratson attr.u.vlan_protocol = ntohs(oldproto); 899dcbdf135SVladimir Oltean switchdev_port_attr_set(br->dev, &attr, NULL); 90022ec19f3SDanielle Ratson 901907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(vlan, &vg->vlan_list, vlist) 9022594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 903204177f3SToshiaki Makita 904907b1e6eSNikolay Aleksandrov list_for_each_entry_continue_reverse(p, &br->port_list, list) { 905907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 906907b1e6eSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 9072594e906SNikolay Aleksandrov vlan_vid_del(p->dev, proto, vlan->vid); 908907b1e6eSNikolay Aleksandrov } 909204177f3SToshiaki Makita 910d2d427b3SToshiaki Makita return err; 911d2d427b3SToshiaki Makita } 912d2d427b3SToshiaki Makita 9139e781401SVladimir Oltean int br_vlan_set_proto(struct net_bridge *br, unsigned long val, 9149e781401SVladimir Oltean struct netlink_ext_ack *extack) 915d2d427b3SToshiaki Makita { 916a98c0c47SMenglong Dong if (!eth_type_vlan(htons(val))) 917d2d427b3SToshiaki Makita return -EPROTONOSUPPORT; 918d2d427b3SToshiaki Makita 919dcbdf135SVladimir Oltean return __br_vlan_set_proto(br, htons(val), extack); 920204177f3SToshiaki Makita } 921204177f3SToshiaki Makita 9226dada9b1SNikolay Aleksandrov int br_vlan_set_stats(struct net_bridge *br, unsigned long val) 9236dada9b1SNikolay Aleksandrov { 9246dada9b1SNikolay Aleksandrov switch (val) { 9256dada9b1SNikolay Aleksandrov case 0: 9266dada9b1SNikolay Aleksandrov case 1: 927ae75767eSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_STATS_ENABLED, !!val); 9286dada9b1SNikolay Aleksandrov break; 9296dada9b1SNikolay Aleksandrov default: 9306dada9b1SNikolay Aleksandrov return -EINVAL; 9316dada9b1SNikolay Aleksandrov } 9326dada9b1SNikolay Aleksandrov 9336dada9b1SNikolay Aleksandrov return 0; 9346dada9b1SNikolay Aleksandrov } 9356dada9b1SNikolay Aleksandrov 9369163a0fcSNikolay Aleksandrov int br_vlan_set_stats_per_port(struct net_bridge *br, unsigned long val) 9379163a0fcSNikolay Aleksandrov { 9389163a0fcSNikolay Aleksandrov struct net_bridge_port *p; 9399163a0fcSNikolay Aleksandrov 9409163a0fcSNikolay Aleksandrov /* allow to change the option if there are no port vlans configured */ 9419163a0fcSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 9429163a0fcSNikolay Aleksandrov struct net_bridge_vlan_group *vg = nbp_vlan_group(p); 9439163a0fcSNikolay Aleksandrov 9449163a0fcSNikolay Aleksandrov if (vg->num_vlans) 9459163a0fcSNikolay Aleksandrov return -EBUSY; 9469163a0fcSNikolay Aleksandrov } 9479163a0fcSNikolay Aleksandrov 9489163a0fcSNikolay Aleksandrov switch (val) { 9499163a0fcSNikolay Aleksandrov case 0: 9509163a0fcSNikolay Aleksandrov case 1: 9519163a0fcSNikolay Aleksandrov br_opt_toggle(br, BROPT_VLAN_STATS_PER_PORT, !!val); 9529163a0fcSNikolay Aleksandrov break; 9539163a0fcSNikolay Aleksandrov default: 9549163a0fcSNikolay Aleksandrov return -EINVAL; 9559163a0fcSNikolay Aleksandrov } 9569163a0fcSNikolay Aleksandrov 9579163a0fcSNikolay Aleksandrov return 0; 9589163a0fcSNikolay Aleksandrov } 9599163a0fcSNikolay Aleksandrov 96077751ee8SNikolay Aleksandrov static bool vlan_default_pvid(struct net_bridge_vlan_group *vg, u16 vid) 9615be5a2dfSVlad Yasevich { 9622594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 9632594e906SNikolay Aleksandrov 96477751ee8SNikolay Aleksandrov if (vid != vg->pvid) 9652594e906SNikolay Aleksandrov return false; 9662594e906SNikolay Aleksandrov 9672594e906SNikolay Aleksandrov v = br_vlan_lookup(&vg->vlan_hash, vid); 9682594e906SNikolay Aleksandrov if (v && br_vlan_should_use(v) && 9692594e906SNikolay Aleksandrov (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) 9702594e906SNikolay Aleksandrov return true; 9712594e906SNikolay Aleksandrov 9722594e906SNikolay Aleksandrov return false; 9735be5a2dfSVlad Yasevich } 9745be5a2dfSVlad Yasevich 9755be5a2dfSVlad Yasevich static void br_vlan_disable_default_pvid(struct net_bridge *br) 9765be5a2dfSVlad Yasevich { 9775be5a2dfSVlad Yasevich struct net_bridge_port *p; 9785be5a2dfSVlad Yasevich u16 pvid = br->default_pvid; 9795be5a2dfSVlad Yasevich 9805be5a2dfSVlad Yasevich /* Disable default_pvid on all ports where it is still 9815be5a2dfSVlad Yasevich * configured. 9825be5a2dfSVlad Yasevich */ 983f545923bSNikolay Aleksandrov if (vlan_default_pvid(br_vlan_group(br), pvid)) { 984f545923bSNikolay Aleksandrov if (!br_vlan_delete(br, pvid)) 985f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN); 986f545923bSNikolay Aleksandrov } 9875be5a2dfSVlad Yasevich 9885be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 989f545923bSNikolay Aleksandrov if (vlan_default_pvid(nbp_vlan_group(p), pvid) && 990f545923bSNikolay Aleksandrov !nbp_vlan_delete(p, pvid)) 991f545923bSNikolay Aleksandrov br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN); 9925be5a2dfSVlad Yasevich } 9935be5a2dfSVlad Yasevich 9945be5a2dfSVlad Yasevich br->default_pvid = 0; 9955be5a2dfSVlad Yasevich } 9965be5a2dfSVlad Yasevich 997169327d5SPetr Machata int __br_vlan_set_default_pvid(struct net_bridge *br, u16 pvid, 998169327d5SPetr Machata struct netlink_ext_ack *extack) 9995be5a2dfSVlad Yasevich { 10002594e906SNikolay Aleksandrov const struct net_bridge_vlan *pvent; 1001907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 10025be5a2dfSVlad Yasevich struct net_bridge_port *p; 1003f418af63SNikolay Aleksandrov unsigned long *changed; 1004f418af63SNikolay Aleksandrov bool vlchange; 10055be5a2dfSVlad Yasevich u16 old_pvid; 10065be5a2dfSVlad Yasevich int err = 0; 10075be5a2dfSVlad Yasevich 10080f963b75SNikolay Aleksandrov if (!pvid) { 10090f963b75SNikolay Aleksandrov br_vlan_disable_default_pvid(br); 10100f963b75SNikolay Aleksandrov return 0; 10110f963b75SNikolay Aleksandrov } 10120f963b75SNikolay Aleksandrov 1013459479daSAndy Shevchenko changed = bitmap_zalloc(BR_MAX_PORTS, GFP_KERNEL); 10145be5a2dfSVlad Yasevich if (!changed) 10155be5a2dfSVlad Yasevich return -ENOMEM; 10165be5a2dfSVlad Yasevich 10175be5a2dfSVlad Yasevich old_pvid = br->default_pvid; 10185be5a2dfSVlad Yasevich 10195be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 10205be5a2dfSVlad Yasevich * user configuration. 10215be5a2dfSVlad Yasevich */ 1022907b1e6eSNikolay Aleksandrov vg = br_vlan_group(br); 1023907b1e6eSNikolay Aleksandrov pvent = br_vlan_find(vg, pvid); 1024907b1e6eSNikolay Aleksandrov if ((!old_pvid || vlan_default_pvid(vg, old_pvid)) && 10252594e906SNikolay Aleksandrov (!pvent || !br_vlan_should_use(pvent))) { 10265be5a2dfSVlad Yasevich err = br_vlan_add(br, pvid, 10275be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 10282594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 1029f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, 1030169327d5SPetr Machata &vlchange, extack); 10315be5a2dfSVlad Yasevich if (err) 10325be5a2dfSVlad Yasevich goto out; 1033f545923bSNikolay Aleksandrov 1034f545923bSNikolay Aleksandrov if (br_vlan_delete(br, old_pvid)) 1035f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, old_pvid, 0, RTM_DELVLAN); 1036f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, pvid, 0, RTM_NEWVLAN); 10375be5a2dfSVlad Yasevich set_bit(0, changed); 10385be5a2dfSVlad Yasevich } 10395be5a2dfSVlad Yasevich 10405be5a2dfSVlad Yasevich list_for_each_entry(p, &br->port_list, list) { 10415be5a2dfSVlad Yasevich /* Update default_pvid config only if we do not conflict with 10425be5a2dfSVlad Yasevich * user configuration. 10435be5a2dfSVlad Yasevich */ 1044907b1e6eSNikolay Aleksandrov vg = nbp_vlan_group(p); 10455be5a2dfSVlad Yasevich if ((old_pvid && 1046907b1e6eSNikolay Aleksandrov !vlan_default_pvid(vg, old_pvid)) || 1047907b1e6eSNikolay Aleksandrov br_vlan_find(vg, pvid)) 10485be5a2dfSVlad Yasevich continue; 10495be5a2dfSVlad Yasevich 10505be5a2dfSVlad Yasevich err = nbp_vlan_add(p, pvid, 10515be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 1052f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 1053169327d5SPetr Machata &vlchange, extack); 10545be5a2dfSVlad Yasevich if (err) 10555be5a2dfSVlad Yasevich goto err_port; 1056f545923bSNikolay Aleksandrov if (nbp_vlan_delete(p, old_pvid)) 1057f545923bSNikolay Aleksandrov br_vlan_notify(br, p, old_pvid, 0, RTM_DELVLAN); 1058f545923bSNikolay Aleksandrov br_vlan_notify(p->br, p, pvid, 0, RTM_NEWVLAN); 10595be5a2dfSVlad Yasevich set_bit(p->port_no, changed); 10605be5a2dfSVlad Yasevich } 10615be5a2dfSVlad Yasevich 10625be5a2dfSVlad Yasevich br->default_pvid = pvid; 10635be5a2dfSVlad Yasevich 10645be5a2dfSVlad Yasevich out: 1065459479daSAndy Shevchenko bitmap_free(changed); 10665be5a2dfSVlad Yasevich return err; 10675be5a2dfSVlad Yasevich 10685be5a2dfSVlad Yasevich err_port: 10695be5a2dfSVlad Yasevich list_for_each_entry_continue_reverse(p, &br->port_list, list) { 10705be5a2dfSVlad Yasevich if (!test_bit(p->port_no, changed)) 10715be5a2dfSVlad Yasevich continue; 10725be5a2dfSVlad Yasevich 1073f545923bSNikolay Aleksandrov if (old_pvid) { 10745be5a2dfSVlad Yasevich nbp_vlan_add(p, old_pvid, 10755be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 1076f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 1077169327d5SPetr Machata &vlchange, NULL); 1078f545923bSNikolay Aleksandrov br_vlan_notify(p->br, p, old_pvid, 0, RTM_NEWVLAN); 1079f545923bSNikolay Aleksandrov } 10805be5a2dfSVlad Yasevich nbp_vlan_delete(p, pvid); 1081f545923bSNikolay Aleksandrov br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN); 10825be5a2dfSVlad Yasevich } 10835be5a2dfSVlad Yasevich 10845be5a2dfSVlad Yasevich if (test_bit(0, changed)) { 1085f545923bSNikolay Aleksandrov if (old_pvid) { 10865be5a2dfSVlad Yasevich br_vlan_add(br, old_pvid, 10875be5a2dfSVlad Yasevich BRIDGE_VLAN_INFO_PVID | 10882594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 1089f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, 1090169327d5SPetr Machata &vlchange, NULL); 1091f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, old_pvid, 0, RTM_NEWVLAN); 1092f545923bSNikolay Aleksandrov } 10935be5a2dfSVlad Yasevich br_vlan_delete(br, pvid); 1094f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN); 10955be5a2dfSVlad Yasevich } 10965be5a2dfSVlad Yasevich goto out; 10975be5a2dfSVlad Yasevich } 10985be5a2dfSVlad Yasevich 10999e781401SVladimir Oltean int br_vlan_set_default_pvid(struct net_bridge *br, unsigned long val, 11009e781401SVladimir Oltean struct netlink_ext_ack *extack) 110196a20d9dSVlad Yasevich { 110296a20d9dSVlad Yasevich u16 pvid = val; 110396a20d9dSVlad Yasevich int err = 0; 110496a20d9dSVlad Yasevich 11055be5a2dfSVlad Yasevich if (val >= VLAN_VID_MASK) 110696a20d9dSVlad Yasevich return -EINVAL; 110796a20d9dSVlad Yasevich 110896a20d9dSVlad Yasevich if (pvid == br->default_pvid) 1109047831a9SXin Long goto out; 111096a20d9dSVlad Yasevich 111196a20d9dSVlad Yasevich /* Only allow default pvid change when filtering is disabled */ 1112ae75767eSNikolay Aleksandrov if (br_opt_get(br, BROPT_VLAN_ENABLED)) { 111396a20d9dSVlad Yasevich pr_info_once("Please disable vlan filtering to change default_pvid\n"); 111496a20d9dSVlad Yasevich err = -EPERM; 1115047831a9SXin Long goto out; 111696a20d9dSVlad Yasevich } 11179e781401SVladimir Oltean err = __br_vlan_set_default_pvid(br, pvid, extack); 1118047831a9SXin Long out: 111996a20d9dSVlad Yasevich return err; 112096a20d9dSVlad Yasevich } 112196a20d9dSVlad Yasevich 11225be5a2dfSVlad Yasevich int br_vlan_init(struct net_bridge *br) 11238580e211SToshiaki Makita { 1124907b1e6eSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 11252594e906SNikolay Aleksandrov int ret = -ENOMEM; 11262594e906SNikolay Aleksandrov 1127907b1e6eSNikolay Aleksandrov vg = kzalloc(sizeof(*vg), GFP_KERNEL); 1128907b1e6eSNikolay Aleksandrov if (!vg) 11292594e906SNikolay Aleksandrov goto out; 1130907b1e6eSNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 11312594e906SNikolay Aleksandrov if (ret) 11322594e906SNikolay Aleksandrov goto err_rhtbl; 1133efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 1134efa5356bSRoopa Prabhu if (ret) 1135efa5356bSRoopa Prabhu goto err_tunnel_init; 1136907b1e6eSNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 11378580e211SToshiaki Makita br->vlan_proto = htons(ETH_P_8021Q); 113896a20d9dSVlad Yasevich br->default_pvid = 1; 1139907b1e6eSNikolay Aleksandrov rcu_assign_pointer(br->vlgrp, vg); 11402594e906SNikolay Aleksandrov 11412594e906SNikolay Aleksandrov out: 11422594e906SNikolay Aleksandrov return ret; 11432594e906SNikolay Aleksandrov 1144efa5356bSRoopa Prabhu err_tunnel_init: 1145907b1e6eSNikolay Aleksandrov rhashtable_destroy(&vg->vlan_hash); 11462594e906SNikolay Aleksandrov err_rhtbl: 1147907b1e6eSNikolay Aleksandrov kfree(vg); 11482594e906SNikolay Aleksandrov 11492594e906SNikolay Aleksandrov goto out; 11502594e906SNikolay Aleksandrov } 11512594e906SNikolay Aleksandrov 1152169327d5SPetr Machata int nbp_vlan_init(struct net_bridge_port *p, struct netlink_ext_ack *extack) 11532594e906SNikolay Aleksandrov { 1154404cdbf0SElad Raz struct switchdev_attr attr = { 1155404cdbf0SElad Raz .orig_dev = p->br->dev, 1156404cdbf0SElad Raz .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, 1157404cdbf0SElad Raz .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, 1158ae75767eSNikolay Aleksandrov .u.vlan_filtering = br_opt_get(p->br, BROPT_VLAN_ENABLED), 1159404cdbf0SElad Raz }; 1160263344e6SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 11612594e906SNikolay Aleksandrov int ret = -ENOMEM; 11622594e906SNikolay Aleksandrov 1163263344e6SNikolay Aleksandrov vg = kzalloc(sizeof(struct net_bridge_vlan_group), GFP_KERNEL); 1164263344e6SNikolay Aleksandrov if (!vg) 11652594e906SNikolay Aleksandrov goto out; 11662594e906SNikolay Aleksandrov 1167dcbdf135SVladimir Oltean ret = switchdev_port_attr_set(p->dev, &attr, extack); 1168404cdbf0SElad Raz if (ret && ret != -EOPNOTSUPP) 1169404cdbf0SElad Raz goto err_vlan_enabled; 1170404cdbf0SElad Raz 1171263344e6SNikolay Aleksandrov ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); 11722594e906SNikolay Aleksandrov if (ret) 11732594e906SNikolay Aleksandrov goto err_rhtbl; 1174efa5356bSRoopa Prabhu ret = vlan_tunnel_init(vg); 1175efa5356bSRoopa Prabhu if (ret) 1176efa5356bSRoopa Prabhu goto err_tunnel_init; 1177263344e6SNikolay Aleksandrov INIT_LIST_HEAD(&vg->vlan_list); 1178907b1e6eSNikolay Aleksandrov rcu_assign_pointer(p->vlgrp, vg); 11792594e906SNikolay Aleksandrov if (p->br->default_pvid) { 1180f418af63SNikolay Aleksandrov bool changed; 1181f418af63SNikolay Aleksandrov 11822594e906SNikolay Aleksandrov ret = nbp_vlan_add(p, p->br->default_pvid, 11832594e906SNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | 1184f418af63SNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED, 1185169327d5SPetr Machata &changed, extack); 11862594e906SNikolay Aleksandrov if (ret) 11872594e906SNikolay Aleksandrov goto err_vlan_add; 1188f545923bSNikolay Aleksandrov br_vlan_notify(p->br, p, p->br->default_pvid, 0, RTM_NEWVLAN); 11892594e906SNikolay Aleksandrov } 11902594e906SNikolay Aleksandrov out: 11912594e906SNikolay Aleksandrov return ret; 11922594e906SNikolay Aleksandrov 11932594e906SNikolay Aleksandrov err_vlan_add: 119407bc588fSIdo Schimmel RCU_INIT_POINTER(p->vlgrp, NULL); 119507bc588fSIdo Schimmel synchronize_rcu(); 1196efa5356bSRoopa Prabhu vlan_tunnel_deinit(vg); 1197efa5356bSRoopa Prabhu err_tunnel_init: 1198efa5356bSRoopa Prabhu rhashtable_destroy(&vg->vlan_hash); 11992594e906SNikolay Aleksandrov err_rhtbl: 1200df2c4334SYotam Gigi err_vlan_enabled: 1201263344e6SNikolay Aleksandrov kfree(vg); 12022594e906SNikolay Aleksandrov 12032594e906SNikolay Aleksandrov goto out; 12048580e211SToshiaki Makita } 12058580e211SToshiaki Makita 12068adff41cSToshiaki Makita /* Must be protected by RTNL. 12078adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 1208f418af63SNikolay Aleksandrov * changed must be true only if the vlan was created or updated 12098adff41cSToshiaki Makita */ 1210f418af63SNikolay Aleksandrov int nbp_vlan_add(struct net_bridge_port *port, u16 vid, u16 flags, 1211169327d5SPetr Machata bool *changed, struct netlink_ext_ack *extack) 1212243a2e63SVlad Yasevich { 12132594e906SNikolay Aleksandrov struct net_bridge_vlan *vlan; 12142594e906SNikolay Aleksandrov int ret; 1215243a2e63SVlad Yasevich 1216243a2e63SVlad Yasevich ASSERT_RTNL(); 1217243a2e63SVlad Yasevich 1218f418af63SNikolay Aleksandrov *changed = false; 1219907b1e6eSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group(port), vid); 12202594e906SNikolay Aleksandrov if (vlan) { 12217fbac984SIdo Schimmel /* Pass the flags to the hardware bridge */ 1222169327d5SPetr Machata ret = br_switchdev_port_vlan_add(port->dev, vid, flags, extack); 12237fbac984SIdo Schimmel if (ret && ret != -EOPNOTSUPP) 12247fbac984SIdo Schimmel return ret; 1225f418af63SNikolay Aleksandrov *changed = __vlan_add_flags(vlan, flags); 1226f418af63SNikolay Aleksandrov 12272594e906SNikolay Aleksandrov return 0; 1228243a2e63SVlad Yasevich } 1229243a2e63SVlad Yasevich 12302594e906SNikolay Aleksandrov vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); 12312594e906SNikolay Aleksandrov if (!vlan) 12322594e906SNikolay Aleksandrov return -ENOMEM; 1233243a2e63SVlad Yasevich 12342594e906SNikolay Aleksandrov vlan->vid = vid; 12352594e906SNikolay Aleksandrov vlan->port = port; 1236169327d5SPetr Machata ret = __vlan_add(vlan, flags, extack); 12372594e906SNikolay Aleksandrov if (ret) 12382594e906SNikolay Aleksandrov kfree(vlan); 1239f418af63SNikolay Aleksandrov else 1240f418af63SNikolay Aleksandrov *changed = true; 1241243a2e63SVlad Yasevich 12422594e906SNikolay Aleksandrov return ret; 1243243a2e63SVlad Yasevich } 1244243a2e63SVlad Yasevich 12458adff41cSToshiaki Makita /* Must be protected by RTNL. 12468adff41cSToshiaki Makita * Must be called with vid in range from 1 to 4094 inclusive. 12478adff41cSToshiaki Makita */ 1248243a2e63SVlad Yasevich int nbp_vlan_delete(struct net_bridge_port *port, u16 vid) 1249243a2e63SVlad Yasevich { 12502594e906SNikolay Aleksandrov struct net_bridge_vlan *v; 1251243a2e63SVlad Yasevich 1252243a2e63SVlad Yasevich ASSERT_RTNL(); 1253243a2e63SVlad Yasevich 1254907b1e6eSNikolay Aleksandrov v = br_vlan_find(nbp_vlan_group(port), vid); 12552594e906SNikolay Aleksandrov if (!v) 12562594e906SNikolay Aleksandrov return -ENOENT; 1257424bb9c9SToshiaki Makita br_fdb_find_delete_local(port->br, port, port->dev->dev_addr, vid); 12581ea2d020SNikolay Aleksandrov br_fdb_delete_by_port(port->br, port, vid, 0); 1259bc9a25d2SVlad Yasevich 12602594e906SNikolay Aleksandrov return __vlan_del(v); 1261243a2e63SVlad Yasevich } 1262243a2e63SVlad Yasevich 1263243a2e63SVlad Yasevich void nbp_vlan_flush(struct net_bridge_port *port) 1264243a2e63SVlad Yasevich { 1265f409d0edSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 1266f409d0edSNikolay Aleksandrov 1267243a2e63SVlad Yasevich ASSERT_RTNL(); 1268243a2e63SVlad Yasevich 1269f409d0edSNikolay Aleksandrov vg = nbp_vlan_group(port); 1270f545923bSNikolay Aleksandrov __vlan_flush(port->br, port, vg); 1271f409d0edSNikolay Aleksandrov RCU_INIT_POINTER(port->vlgrp, NULL); 1272f409d0edSNikolay Aleksandrov synchronize_rcu(); 1273f409d0edSNikolay Aleksandrov __vlan_group_free(vg); 12745be5a2dfSVlad Yasevich } 1275a60c0903SNikolay Aleksandrov 1276a60c0903SNikolay Aleksandrov void br_vlan_get_stats(const struct net_bridge_vlan *v, 1277281cc284SHeiner Kallweit struct pcpu_sw_netstats *stats) 1278a60c0903SNikolay Aleksandrov { 1279a60c0903SNikolay Aleksandrov int i; 1280a60c0903SNikolay Aleksandrov 1281a60c0903SNikolay Aleksandrov memset(stats, 0, sizeof(*stats)); 1282a60c0903SNikolay Aleksandrov for_each_possible_cpu(i) { 1283a60c0903SNikolay Aleksandrov u64 rxpackets, rxbytes, txpackets, txbytes; 1284281cc284SHeiner Kallweit struct pcpu_sw_netstats *cpu_stats; 1285a60c0903SNikolay Aleksandrov unsigned int start; 1286a60c0903SNikolay Aleksandrov 1287a60c0903SNikolay Aleksandrov cpu_stats = per_cpu_ptr(v->stats, i); 1288a60c0903SNikolay Aleksandrov do { 1289a60c0903SNikolay Aleksandrov start = u64_stats_fetch_begin_irq(&cpu_stats->syncp); 1290a60c0903SNikolay Aleksandrov rxpackets = cpu_stats->rx_packets; 1291a60c0903SNikolay Aleksandrov rxbytes = cpu_stats->rx_bytes; 1292a60c0903SNikolay Aleksandrov txbytes = cpu_stats->tx_bytes; 1293a60c0903SNikolay Aleksandrov txpackets = cpu_stats->tx_packets; 1294a60c0903SNikolay Aleksandrov } while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start)); 1295a60c0903SNikolay Aleksandrov 1296a60c0903SNikolay Aleksandrov stats->rx_packets += rxpackets; 1297a60c0903SNikolay Aleksandrov stats->rx_bytes += rxbytes; 1298a60c0903SNikolay Aleksandrov stats->tx_bytes += txbytes; 1299a60c0903SNikolay Aleksandrov stats->tx_packets += txpackets; 1300a60c0903SNikolay Aleksandrov } 1301a60c0903SNikolay Aleksandrov } 13024d4fd361SPetr Machata 130399f62a74SVladimir Oltean int br_vlan_get_pvid(const struct net_device *dev, u16 *p_pvid) 13044d4fd361SPetr Machata { 13054d4fd361SPetr Machata struct net_bridge_vlan_group *vg; 130699f62a74SVladimir Oltean struct net_bridge_port *p; 13074d4fd361SPetr Machata 130899f62a74SVladimir Oltean ASSERT_RTNL(); 130999f62a74SVladimir Oltean p = br_port_get_check_rtnl(dev); 13105a6db04cSIdo Schimmel if (p) 13115a6db04cSIdo Schimmel vg = nbp_vlan_group(p); 13125a6db04cSIdo Schimmel else if (netif_is_bridge_master(dev)) 13134d4fd361SPetr Machata vg = br_vlan_group(netdev_priv(dev)); 13144d4fd361SPetr Machata else 13154d4fd361SPetr Machata return -EINVAL; 13164d4fd361SPetr Machata 13174d4fd361SPetr Machata *p_pvid = br_get_pvid(vg); 13184d4fd361SPetr Machata return 0; 13194d4fd361SPetr Machata } 13204d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_pvid); 13214d4fd361SPetr Machata 13227582f5b7SPablo Neira Ayuso int br_vlan_get_pvid_rcu(const struct net_device *dev, u16 *p_pvid) 13237582f5b7SPablo Neira Ayuso { 132499f62a74SVladimir Oltean struct net_bridge_vlan_group *vg; 132599f62a74SVladimir Oltean struct net_bridge_port *p; 132699f62a74SVladimir Oltean 132799f62a74SVladimir Oltean p = br_port_get_check_rcu(dev); 132899f62a74SVladimir Oltean if (p) 132999f62a74SVladimir Oltean vg = nbp_vlan_group_rcu(p); 133099f62a74SVladimir Oltean else if (netif_is_bridge_master(dev)) 133199f62a74SVladimir Oltean vg = br_vlan_group_rcu(netdev_priv(dev)); 133299f62a74SVladimir Oltean else 133399f62a74SVladimir Oltean return -EINVAL; 133499f62a74SVladimir Oltean 133599f62a74SVladimir Oltean *p_pvid = br_get_pvid(vg); 133699f62a74SVladimir Oltean return 0; 13377582f5b7SPablo Neira Ayuso } 13387582f5b7SPablo Neira Ayuso EXPORT_SYMBOL_GPL(br_vlan_get_pvid_rcu); 13397582f5b7SPablo Neira Ayuso 1340bcf2766bSFelix Fietkau void br_vlan_fill_forward_path_pvid(struct net_bridge *br, 1341bcf2766bSFelix Fietkau struct net_device_path_ctx *ctx, 1342bcf2766bSFelix Fietkau struct net_device_path *path) 1343bcf2766bSFelix Fietkau { 1344bcf2766bSFelix Fietkau struct net_bridge_vlan_group *vg; 1345bcf2766bSFelix Fietkau int idx = ctx->num_vlans - 1; 1346bcf2766bSFelix Fietkau u16 vid; 1347bcf2766bSFelix Fietkau 1348bcf2766bSFelix Fietkau path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP; 1349bcf2766bSFelix Fietkau 1350bcf2766bSFelix Fietkau if (!br_opt_get(br, BROPT_VLAN_ENABLED)) 1351bcf2766bSFelix Fietkau return; 1352bcf2766bSFelix Fietkau 1353bcf2766bSFelix Fietkau vg = br_vlan_group(br); 1354bcf2766bSFelix Fietkau 1355bcf2766bSFelix Fietkau if (idx >= 0 && 1356bcf2766bSFelix Fietkau ctx->vlan[idx].proto == br->vlan_proto) { 1357bcf2766bSFelix Fietkau vid = ctx->vlan[idx].id; 1358bcf2766bSFelix Fietkau } else { 1359bcf2766bSFelix Fietkau path->bridge.vlan_mode = DEV_PATH_BR_VLAN_TAG; 1360bcf2766bSFelix Fietkau vid = br_get_pvid(vg); 1361bcf2766bSFelix Fietkau } 1362bcf2766bSFelix Fietkau 1363bcf2766bSFelix Fietkau path->bridge.vlan_id = vid; 1364bcf2766bSFelix Fietkau path->bridge.vlan_proto = br->vlan_proto; 1365bcf2766bSFelix Fietkau } 1366bcf2766bSFelix Fietkau 1367bcf2766bSFelix Fietkau int br_vlan_fill_forward_path_mode(struct net_bridge *br, 1368bcf2766bSFelix Fietkau struct net_bridge_port *dst, 1369bcf2766bSFelix Fietkau struct net_device_path *path) 1370bcf2766bSFelix Fietkau { 1371bcf2766bSFelix Fietkau struct net_bridge_vlan_group *vg; 1372bcf2766bSFelix Fietkau struct net_bridge_vlan *v; 1373bcf2766bSFelix Fietkau 1374bcf2766bSFelix Fietkau if (!br_opt_get(br, BROPT_VLAN_ENABLED)) 1375bcf2766bSFelix Fietkau return 0; 1376bcf2766bSFelix Fietkau 1377bcf2766bSFelix Fietkau vg = nbp_vlan_group_rcu(dst); 1378bcf2766bSFelix Fietkau v = br_vlan_find(vg, path->bridge.vlan_id); 1379bcf2766bSFelix Fietkau if (!v || !br_vlan_should_use(v)) 1380bcf2766bSFelix Fietkau return -EINVAL; 1381bcf2766bSFelix Fietkau 1382bcf2766bSFelix Fietkau if (!(v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) 1383bcf2766bSFelix Fietkau return 0; 1384bcf2766bSFelix Fietkau 1385bcf2766bSFelix Fietkau if (path->bridge.vlan_mode == DEV_PATH_BR_VLAN_TAG) 1386bcf2766bSFelix Fietkau path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP; 138726267bf9SFelix Fietkau else if (v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) 138826267bf9SFelix Fietkau path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG_HW; 1389bcf2766bSFelix Fietkau else 1390bcf2766bSFelix Fietkau path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG; 1391bcf2766bSFelix Fietkau 1392bcf2766bSFelix Fietkau return 0; 1393bcf2766bSFelix Fietkau } 1394bcf2766bSFelix Fietkau 13954d4fd361SPetr Machata int br_vlan_get_info(const struct net_device *dev, u16 vid, 13964d4fd361SPetr Machata struct bridge_vlan_info *p_vinfo) 13974d4fd361SPetr Machata { 13984d4fd361SPetr Machata struct net_bridge_vlan_group *vg; 13994d4fd361SPetr Machata struct net_bridge_vlan *v; 14004d4fd361SPetr Machata struct net_bridge_port *p; 14014d4fd361SPetr Machata 14024d4fd361SPetr Machata ASSERT_RTNL(); 14034d4fd361SPetr Machata p = br_port_get_check_rtnl(dev); 14044d4fd361SPetr Machata if (p) 14054d4fd361SPetr Machata vg = nbp_vlan_group(p); 14062b18d79eSPetr Machata else if (netif_is_bridge_master(dev)) 14072b18d79eSPetr Machata vg = br_vlan_group(netdev_priv(dev)); 14084d4fd361SPetr Machata else 14094d4fd361SPetr Machata return -EINVAL; 14104d4fd361SPetr Machata 14114d4fd361SPetr Machata v = br_vlan_find(vg, vid); 14124d4fd361SPetr Machata if (!v) 14134d4fd361SPetr Machata return -ENOENT; 14144d4fd361SPetr Machata 14154d4fd361SPetr Machata p_vinfo->vid = vid; 14164d4fd361SPetr Machata p_vinfo->flags = v->flags; 1417f40d9b20SVladimir Oltean if (vid == br_get_pvid(vg)) 1418f40d9b20SVladimir Oltean p_vinfo->flags |= BRIDGE_VLAN_INFO_PVID; 14194d4fd361SPetr Machata return 0; 14204d4fd361SPetr Machata } 14214d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_info); 14229c0ec2e7SMike Manning 14239c0ec2e7SMike Manning static int br_vlan_is_bind_vlan_dev(const struct net_device *dev) 14249c0ec2e7SMike Manning { 14259c0ec2e7SMike Manning return is_vlan_dev(dev) && 14269c0ec2e7SMike Manning !!(vlan_dev_priv(dev)->flags & VLAN_FLAG_BRIDGE_BINDING); 14279c0ec2e7SMike Manning } 14289c0ec2e7SMike Manning 14299c0ec2e7SMike Manning static int br_vlan_is_bind_vlan_dev_fn(struct net_device *dev, 1430eff74233STaehee Yoo __always_unused struct netdev_nested_priv *priv) 14319c0ec2e7SMike Manning { 14329c0ec2e7SMike Manning return br_vlan_is_bind_vlan_dev(dev); 14339c0ec2e7SMike Manning } 14349c0ec2e7SMike Manning 14359c0ec2e7SMike Manning static bool br_vlan_has_upper_bind_vlan_dev(struct net_device *dev) 14369c0ec2e7SMike Manning { 14379c0ec2e7SMike Manning int found; 14389c0ec2e7SMike Manning 14399c0ec2e7SMike Manning rcu_read_lock(); 14409c0ec2e7SMike Manning found = netdev_walk_all_upper_dev_rcu(dev, br_vlan_is_bind_vlan_dev_fn, 14419c0ec2e7SMike Manning NULL); 14429c0ec2e7SMike Manning rcu_read_unlock(); 14439c0ec2e7SMike Manning 14449c0ec2e7SMike Manning return !!found; 14459c0ec2e7SMike Manning } 14469c0ec2e7SMike Manning 14479c0ec2e7SMike Manning struct br_vlan_bind_walk_data { 14489c0ec2e7SMike Manning u16 vid; 14499c0ec2e7SMike Manning struct net_device *result; 14509c0ec2e7SMike Manning }; 14519c0ec2e7SMike Manning 14529c0ec2e7SMike Manning static int br_vlan_match_bind_vlan_dev_fn(struct net_device *dev, 1453eff74233STaehee Yoo struct netdev_nested_priv *priv) 14549c0ec2e7SMike Manning { 1455eff74233STaehee Yoo struct br_vlan_bind_walk_data *data = priv->data; 14569c0ec2e7SMike Manning int found = 0; 14579c0ec2e7SMike Manning 14589c0ec2e7SMike Manning if (br_vlan_is_bind_vlan_dev(dev) && 14599c0ec2e7SMike Manning vlan_dev_priv(dev)->vlan_id == data->vid) { 14609c0ec2e7SMike Manning data->result = dev; 14619c0ec2e7SMike Manning found = 1; 14629c0ec2e7SMike Manning } 14639c0ec2e7SMike Manning 14649c0ec2e7SMike Manning return found; 14659c0ec2e7SMike Manning } 14669c0ec2e7SMike Manning 14679c0ec2e7SMike Manning static struct net_device * 14689c0ec2e7SMike Manning br_vlan_get_upper_bind_vlan_dev(struct net_device *dev, u16 vid) 14699c0ec2e7SMike Manning { 14709c0ec2e7SMike Manning struct br_vlan_bind_walk_data data = { 14719c0ec2e7SMike Manning .vid = vid, 14729c0ec2e7SMike Manning }; 1473eff74233STaehee Yoo struct netdev_nested_priv priv = { 1474eff74233STaehee Yoo .data = (void *)&data, 1475eff74233STaehee Yoo }; 14769c0ec2e7SMike Manning 14779c0ec2e7SMike Manning rcu_read_lock(); 14789c0ec2e7SMike Manning netdev_walk_all_upper_dev_rcu(dev, br_vlan_match_bind_vlan_dev_fn, 1479eff74233STaehee Yoo &priv); 14809c0ec2e7SMike Manning rcu_read_unlock(); 14819c0ec2e7SMike Manning 14829c0ec2e7SMike Manning return data.result; 14839c0ec2e7SMike Manning } 14849c0ec2e7SMike Manning 14859c0ec2e7SMike Manning static bool br_vlan_is_dev_up(const struct net_device *dev) 14869c0ec2e7SMike Manning { 14879c0ec2e7SMike Manning return !!(dev->flags & IFF_UP) && netif_oper_up(dev); 14889c0ec2e7SMike Manning } 14899c0ec2e7SMike Manning 14909c0ec2e7SMike Manning static void br_vlan_set_vlan_dev_state(const struct net_bridge *br, 14919c0ec2e7SMike Manning struct net_device *vlan_dev) 14929c0ec2e7SMike Manning { 14939c0ec2e7SMike Manning u16 vid = vlan_dev_priv(vlan_dev)->vlan_id; 14949c0ec2e7SMike Manning struct net_bridge_vlan_group *vg; 14959c0ec2e7SMike Manning struct net_bridge_port *p; 14969c0ec2e7SMike Manning bool has_carrier = false; 14979c0ec2e7SMike Manning 14988e1acd4fSMike Manning if (!netif_carrier_ok(br->dev)) { 14998e1acd4fSMike Manning netif_carrier_off(vlan_dev); 15008e1acd4fSMike Manning return; 15018e1acd4fSMike Manning } 15028e1acd4fSMike Manning 15039c0ec2e7SMike Manning list_for_each_entry(p, &br->port_list, list) { 15049c0ec2e7SMike Manning vg = nbp_vlan_group(p); 15059c0ec2e7SMike Manning if (br_vlan_find(vg, vid) && br_vlan_is_dev_up(p->dev)) { 15069c0ec2e7SMike Manning has_carrier = true; 15079c0ec2e7SMike Manning break; 15089c0ec2e7SMike Manning } 15099c0ec2e7SMike Manning } 15109c0ec2e7SMike Manning 15119c0ec2e7SMike Manning if (has_carrier) 15129c0ec2e7SMike Manning netif_carrier_on(vlan_dev); 15139c0ec2e7SMike Manning else 15149c0ec2e7SMike Manning netif_carrier_off(vlan_dev); 15159c0ec2e7SMike Manning } 15169c0ec2e7SMike Manning 15179c0ec2e7SMike Manning static void br_vlan_set_all_vlan_dev_state(struct net_bridge_port *p) 15189c0ec2e7SMike Manning { 15199c0ec2e7SMike Manning struct net_bridge_vlan_group *vg = nbp_vlan_group(p); 15209c0ec2e7SMike Manning struct net_bridge_vlan *vlan; 15219c0ec2e7SMike Manning struct net_device *vlan_dev; 15229c0ec2e7SMike Manning 15239c0ec2e7SMike Manning list_for_each_entry(vlan, &vg->vlan_list, vlist) { 15249c0ec2e7SMike Manning vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev, 15259c0ec2e7SMike Manning vlan->vid); 15269c0ec2e7SMike Manning if (vlan_dev) { 15278e1acd4fSMike Manning if (br_vlan_is_dev_up(p->dev)) { 15288e1acd4fSMike Manning if (netif_carrier_ok(p->br->dev)) 15299c0ec2e7SMike Manning netif_carrier_on(vlan_dev); 15308e1acd4fSMike Manning } else { 15319c0ec2e7SMike Manning br_vlan_set_vlan_dev_state(p->br, vlan_dev); 15329c0ec2e7SMike Manning } 15339c0ec2e7SMike Manning } 15349c0ec2e7SMike Manning } 15358e1acd4fSMike Manning } 15369c0ec2e7SMike Manning 15379c0ec2e7SMike Manning static void br_vlan_upper_change(struct net_device *dev, 15389c0ec2e7SMike Manning struct net_device *upper_dev, 15399c0ec2e7SMike Manning bool linking) 15409c0ec2e7SMike Manning { 15419c0ec2e7SMike Manning struct net_bridge *br = netdev_priv(dev); 15429c0ec2e7SMike Manning 15439c0ec2e7SMike Manning if (!br_vlan_is_bind_vlan_dev(upper_dev)) 15449c0ec2e7SMike Manning return; 15459c0ec2e7SMike Manning 15469c0ec2e7SMike Manning if (linking) { 15479c0ec2e7SMike Manning br_vlan_set_vlan_dev_state(br, upper_dev); 15489c0ec2e7SMike Manning br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING, true); 15499c0ec2e7SMike Manning } else { 15509c0ec2e7SMike Manning br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING, 15519c0ec2e7SMike Manning br_vlan_has_upper_bind_vlan_dev(dev)); 15529c0ec2e7SMike Manning } 15539c0ec2e7SMike Manning } 15549c0ec2e7SMike Manning 15558e1acd4fSMike Manning struct br_vlan_link_state_walk_data { 15568e1acd4fSMike Manning struct net_bridge *br; 15578e1acd4fSMike Manning }; 15588e1acd4fSMike Manning 15598e1acd4fSMike Manning static int br_vlan_link_state_change_fn(struct net_device *vlan_dev, 1560eff74233STaehee Yoo struct netdev_nested_priv *priv) 15618e1acd4fSMike Manning { 1562eff74233STaehee Yoo struct br_vlan_link_state_walk_data *data = priv->data; 15638e1acd4fSMike Manning 15648e1acd4fSMike Manning if (br_vlan_is_bind_vlan_dev(vlan_dev)) 15658e1acd4fSMike Manning br_vlan_set_vlan_dev_state(data->br, vlan_dev); 15668e1acd4fSMike Manning 15678e1acd4fSMike Manning return 0; 15688e1acd4fSMike Manning } 15698e1acd4fSMike Manning 15708e1acd4fSMike Manning static void br_vlan_link_state_change(struct net_device *dev, 15718e1acd4fSMike Manning struct net_bridge *br) 15728e1acd4fSMike Manning { 15738e1acd4fSMike Manning struct br_vlan_link_state_walk_data data = { 15748e1acd4fSMike Manning .br = br 15758e1acd4fSMike Manning }; 1576eff74233STaehee Yoo struct netdev_nested_priv priv = { 1577eff74233STaehee Yoo .data = (void *)&data, 1578eff74233STaehee Yoo }; 15798e1acd4fSMike Manning 15808e1acd4fSMike Manning rcu_read_lock(); 15818e1acd4fSMike Manning netdev_walk_all_upper_dev_rcu(dev, br_vlan_link_state_change_fn, 1582eff74233STaehee Yoo &priv); 15838e1acd4fSMike Manning rcu_read_unlock(); 15848e1acd4fSMike Manning } 15858e1acd4fSMike Manning 15869c0ec2e7SMike Manning /* Must be protected by RTNL. */ 158780900acdSMike Manning static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid) 158880900acdSMike Manning { 158980900acdSMike Manning struct net_device *vlan_dev; 159080900acdSMike Manning 159180900acdSMike Manning if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING)) 159280900acdSMike Manning return; 159380900acdSMike Manning 159480900acdSMike Manning vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev, vid); 159580900acdSMike Manning if (vlan_dev) 159680900acdSMike Manning br_vlan_set_vlan_dev_state(p->br, vlan_dev); 159780900acdSMike Manning } 159880900acdSMike Manning 159980900acdSMike Manning /* Must be protected by RTNL. */ 1600091adf9bSNikolay Aleksandrov int br_vlan_bridge_event(struct net_device *dev, unsigned long event, void *ptr) 16019c0ec2e7SMike Manning { 16029c0ec2e7SMike Manning struct netdev_notifier_changeupper_info *info; 1603091adf9bSNikolay Aleksandrov struct net_bridge *br = netdev_priv(dev); 1604f545923bSNikolay Aleksandrov int vlcmd = 0, ret = 0; 1605f545923bSNikolay Aleksandrov bool changed = false; 16069c0ec2e7SMike Manning 16079c0ec2e7SMike Manning switch (event) { 1608091adf9bSNikolay Aleksandrov case NETDEV_REGISTER: 1609091adf9bSNikolay Aleksandrov ret = br_vlan_add(br, br->default_pvid, 1610091adf9bSNikolay Aleksandrov BRIDGE_VLAN_INFO_PVID | 1611091adf9bSNikolay Aleksandrov BRIDGE_VLAN_INFO_UNTAGGED | 1612091adf9bSNikolay Aleksandrov BRIDGE_VLAN_INFO_BRENTRY, &changed, NULL); 1613f545923bSNikolay Aleksandrov vlcmd = RTM_NEWVLAN; 1614091adf9bSNikolay Aleksandrov break; 1615091adf9bSNikolay Aleksandrov case NETDEV_UNREGISTER: 1616f545923bSNikolay Aleksandrov changed = !br_vlan_delete(br, br->default_pvid); 1617f545923bSNikolay Aleksandrov vlcmd = RTM_DELVLAN; 1618091adf9bSNikolay Aleksandrov break; 16199c0ec2e7SMike Manning case NETDEV_CHANGEUPPER: 16209c0ec2e7SMike Manning info = ptr; 16219c0ec2e7SMike Manning br_vlan_upper_change(dev, info->upper_dev, info->linking); 16229c0ec2e7SMike Manning break; 16238e1acd4fSMike Manning 16248e1acd4fSMike Manning case NETDEV_CHANGE: 16258e1acd4fSMike Manning case NETDEV_UP: 16268e1acd4fSMike Manning if (!br_opt_get(br, BROPT_VLAN_BRIDGE_BINDING)) 1627091adf9bSNikolay Aleksandrov break; 16288e1acd4fSMike Manning br_vlan_link_state_change(dev, br); 16298e1acd4fSMike Manning break; 16309c0ec2e7SMike Manning } 1631f545923bSNikolay Aleksandrov if (changed) 1632f545923bSNikolay Aleksandrov br_vlan_notify(br, NULL, br->default_pvid, 0, vlcmd); 1633091adf9bSNikolay Aleksandrov 1634091adf9bSNikolay Aleksandrov return ret; 16359c0ec2e7SMike Manning } 16369c0ec2e7SMike Manning 16379c0ec2e7SMike Manning /* Must be protected by RTNL. */ 16389c0ec2e7SMike Manning void br_vlan_port_event(struct net_bridge_port *p, unsigned long event) 16399c0ec2e7SMike Manning { 16409c0ec2e7SMike Manning if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING)) 16419c0ec2e7SMike Manning return; 16429c0ec2e7SMike Manning 16439c0ec2e7SMike Manning switch (event) { 16449c0ec2e7SMike Manning case NETDEV_CHANGE: 16459c0ec2e7SMike Manning case NETDEV_DOWN: 16469c0ec2e7SMike Manning case NETDEV_UP: 16479c0ec2e7SMike Manning br_vlan_set_all_vlan_dev_state(p); 16489c0ec2e7SMike Manning break; 16499c0ec2e7SMike Manning } 16509c0ec2e7SMike Manning } 16518dcea187SNikolay Aleksandrov 165256d09976SNikolay Aleksandrov static bool br_vlan_stats_fill(struct sk_buff *skb, 165356d09976SNikolay Aleksandrov const struct net_bridge_vlan *v) 165456d09976SNikolay Aleksandrov { 1655281cc284SHeiner Kallweit struct pcpu_sw_netstats stats; 165656d09976SNikolay Aleksandrov struct nlattr *nest; 165756d09976SNikolay Aleksandrov 165856d09976SNikolay Aleksandrov nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY_STATS); 165956d09976SNikolay Aleksandrov if (!nest) 166056d09976SNikolay Aleksandrov return false; 166156d09976SNikolay Aleksandrov 166256d09976SNikolay Aleksandrov br_vlan_get_stats(v, &stats); 166356d09976SNikolay Aleksandrov if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_BYTES, stats.rx_bytes, 166456d09976SNikolay Aleksandrov BRIDGE_VLANDB_STATS_PAD) || 166556d09976SNikolay Aleksandrov nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_PACKETS, 166656d09976SNikolay Aleksandrov stats.rx_packets, BRIDGE_VLANDB_STATS_PAD) || 166756d09976SNikolay Aleksandrov nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_BYTES, stats.tx_bytes, 166856d09976SNikolay Aleksandrov BRIDGE_VLANDB_STATS_PAD) || 166956d09976SNikolay Aleksandrov nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_PACKETS, 167056d09976SNikolay Aleksandrov stats.tx_packets, BRIDGE_VLANDB_STATS_PAD)) 167156d09976SNikolay Aleksandrov goto out_err; 167256d09976SNikolay Aleksandrov 167356d09976SNikolay Aleksandrov nla_nest_end(skb, nest); 167456d09976SNikolay Aleksandrov 167556d09976SNikolay Aleksandrov return true; 167656d09976SNikolay Aleksandrov 167756d09976SNikolay Aleksandrov out_err: 167856d09976SNikolay Aleksandrov nla_nest_cancel(skb, nest); 167956d09976SNikolay Aleksandrov return false; 168056d09976SNikolay Aleksandrov } 168156d09976SNikolay Aleksandrov 16827a53e718SNikolay Aleksandrov /* v_opts is used to dump the options which must be equal in the whole range */ 16830ab55879SNikolay Aleksandrov static bool br_vlan_fill_vids(struct sk_buff *skb, u16 vid, u16 vid_range, 16847a53e718SNikolay Aleksandrov const struct net_bridge_vlan *v_opts, 168556d09976SNikolay Aleksandrov u16 flags, 168656d09976SNikolay Aleksandrov bool dump_stats) 16878dcea187SNikolay Aleksandrov { 16888dcea187SNikolay Aleksandrov struct bridge_vlan_info info; 16898dcea187SNikolay Aleksandrov struct nlattr *nest; 16908dcea187SNikolay Aleksandrov 16918dcea187SNikolay Aleksandrov nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY); 16928dcea187SNikolay Aleksandrov if (!nest) 16938dcea187SNikolay Aleksandrov return false; 16948dcea187SNikolay Aleksandrov 16958dcea187SNikolay Aleksandrov memset(&info, 0, sizeof(info)); 16968dcea187SNikolay Aleksandrov info.vid = vid; 16978dcea187SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_UNTAGGED) 16988dcea187SNikolay Aleksandrov info.flags |= BRIDGE_VLAN_INFO_UNTAGGED; 16998dcea187SNikolay Aleksandrov if (flags & BRIDGE_VLAN_INFO_PVID) 17008dcea187SNikolay Aleksandrov info.flags |= BRIDGE_VLAN_INFO_PVID; 17018dcea187SNikolay Aleksandrov 17028dcea187SNikolay Aleksandrov if (nla_put(skb, BRIDGE_VLANDB_ENTRY_INFO, sizeof(info), &info)) 17038dcea187SNikolay Aleksandrov goto out_err; 17048dcea187SNikolay Aleksandrov 17050ab55879SNikolay Aleksandrov if (vid_range && vid < vid_range && 17060ab55879SNikolay Aleksandrov !(flags & BRIDGE_VLAN_INFO_PVID) && 17070ab55879SNikolay Aleksandrov nla_put_u16(skb, BRIDGE_VLANDB_ENTRY_RANGE, vid_range)) 17080ab55879SNikolay Aleksandrov goto out_err; 17090ab55879SNikolay Aleksandrov 171056d09976SNikolay Aleksandrov if (v_opts) { 171156d09976SNikolay Aleksandrov if (!br_vlan_opts_fill(skb, v_opts)) 17127a53e718SNikolay Aleksandrov goto out_err; 17137a53e718SNikolay Aleksandrov 171456d09976SNikolay Aleksandrov if (dump_stats && !br_vlan_stats_fill(skb, v_opts)) 171556d09976SNikolay Aleksandrov goto out_err; 171656d09976SNikolay Aleksandrov } 171756d09976SNikolay Aleksandrov 17188dcea187SNikolay Aleksandrov nla_nest_end(skb, nest); 17198dcea187SNikolay Aleksandrov 17208dcea187SNikolay Aleksandrov return true; 17218dcea187SNikolay Aleksandrov 17228dcea187SNikolay Aleksandrov out_err: 17238dcea187SNikolay Aleksandrov nla_nest_cancel(skb, nest); 17248dcea187SNikolay Aleksandrov return false; 17258dcea187SNikolay Aleksandrov } 17268dcea187SNikolay Aleksandrov 1727cf5bddb9SNikolay Aleksandrov static size_t rtnl_vlan_nlmsg_size(void) 1728cf5bddb9SNikolay Aleksandrov { 1729cf5bddb9SNikolay Aleksandrov return NLMSG_ALIGN(sizeof(struct br_vlan_msg)) 1730cf5bddb9SNikolay Aleksandrov + nla_total_size(0) /* BRIDGE_VLANDB_ENTRY */ 1731cf5bddb9SNikolay Aleksandrov + nla_total_size(sizeof(u16)) /* BRIDGE_VLANDB_ENTRY_RANGE */ 17327a53e718SNikolay Aleksandrov + nla_total_size(sizeof(struct bridge_vlan_info)) /* BRIDGE_VLANDB_ENTRY_INFO */ 17337a53e718SNikolay Aleksandrov + br_vlan_opts_nl_size(); /* bridge vlan options */ 1734cf5bddb9SNikolay Aleksandrov } 1735cf5bddb9SNikolay Aleksandrov 1736cf5bddb9SNikolay Aleksandrov void br_vlan_notify(const struct net_bridge *br, 1737cf5bddb9SNikolay Aleksandrov const struct net_bridge_port *p, 1738cf5bddb9SNikolay Aleksandrov u16 vid, u16 vid_range, 1739cf5bddb9SNikolay Aleksandrov int cmd) 1740cf5bddb9SNikolay Aleksandrov { 1741cf5bddb9SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 17427a53e718SNikolay Aleksandrov struct net_bridge_vlan *v = NULL; 1743cf5bddb9SNikolay Aleksandrov struct br_vlan_msg *bvm; 1744cf5bddb9SNikolay Aleksandrov struct nlmsghdr *nlh; 1745cf5bddb9SNikolay Aleksandrov struct sk_buff *skb; 1746cf5bddb9SNikolay Aleksandrov int err = -ENOBUFS; 1747cf5bddb9SNikolay Aleksandrov struct net *net; 1748cf5bddb9SNikolay Aleksandrov u16 flags = 0; 1749cf5bddb9SNikolay Aleksandrov int ifindex; 1750cf5bddb9SNikolay Aleksandrov 1751cf5bddb9SNikolay Aleksandrov /* right now notifications are done only with rtnl held */ 1752cf5bddb9SNikolay Aleksandrov ASSERT_RTNL(); 1753cf5bddb9SNikolay Aleksandrov 1754cf5bddb9SNikolay Aleksandrov if (p) { 1755cf5bddb9SNikolay Aleksandrov ifindex = p->dev->ifindex; 1756cf5bddb9SNikolay Aleksandrov vg = nbp_vlan_group(p); 1757cf5bddb9SNikolay Aleksandrov net = dev_net(p->dev); 1758cf5bddb9SNikolay Aleksandrov } else { 1759cf5bddb9SNikolay Aleksandrov ifindex = br->dev->ifindex; 1760cf5bddb9SNikolay Aleksandrov vg = br_vlan_group(br); 1761cf5bddb9SNikolay Aleksandrov net = dev_net(br->dev); 1762cf5bddb9SNikolay Aleksandrov } 1763cf5bddb9SNikolay Aleksandrov 1764cf5bddb9SNikolay Aleksandrov skb = nlmsg_new(rtnl_vlan_nlmsg_size(), GFP_KERNEL); 1765cf5bddb9SNikolay Aleksandrov if (!skb) 1766cf5bddb9SNikolay Aleksandrov goto out_err; 1767cf5bddb9SNikolay Aleksandrov 1768cf5bddb9SNikolay Aleksandrov err = -EMSGSIZE; 1769cf5bddb9SNikolay Aleksandrov nlh = nlmsg_put(skb, 0, 0, cmd, sizeof(*bvm), 0); 1770cf5bddb9SNikolay Aleksandrov if (!nlh) 1771cf5bddb9SNikolay Aleksandrov goto out_err; 1772cf5bddb9SNikolay Aleksandrov bvm = nlmsg_data(nlh); 1773cf5bddb9SNikolay Aleksandrov memset(bvm, 0, sizeof(*bvm)); 1774cf5bddb9SNikolay Aleksandrov bvm->family = AF_BRIDGE; 1775cf5bddb9SNikolay Aleksandrov bvm->ifindex = ifindex; 1776cf5bddb9SNikolay Aleksandrov 1777cf5bddb9SNikolay Aleksandrov switch (cmd) { 1778cf5bddb9SNikolay Aleksandrov case RTM_NEWVLAN: 1779cf5bddb9SNikolay Aleksandrov /* need to find the vlan due to flags/options */ 1780cf5bddb9SNikolay Aleksandrov v = br_vlan_find(vg, vid); 1781cf5bddb9SNikolay Aleksandrov if (!v || !br_vlan_should_use(v)) 1782cf5bddb9SNikolay Aleksandrov goto out_kfree; 1783cf5bddb9SNikolay Aleksandrov 1784cf5bddb9SNikolay Aleksandrov flags = v->flags; 1785cf5bddb9SNikolay Aleksandrov if (br_get_pvid(vg) == v->vid) 1786cf5bddb9SNikolay Aleksandrov flags |= BRIDGE_VLAN_INFO_PVID; 1787cf5bddb9SNikolay Aleksandrov break; 1788cf5bddb9SNikolay Aleksandrov case RTM_DELVLAN: 1789cf5bddb9SNikolay Aleksandrov break; 1790cf5bddb9SNikolay Aleksandrov default: 1791cf5bddb9SNikolay Aleksandrov goto out_kfree; 1792cf5bddb9SNikolay Aleksandrov } 1793cf5bddb9SNikolay Aleksandrov 179456d09976SNikolay Aleksandrov if (!br_vlan_fill_vids(skb, vid, vid_range, v, flags, false)) 1795cf5bddb9SNikolay Aleksandrov goto out_err; 1796cf5bddb9SNikolay Aleksandrov 1797cf5bddb9SNikolay Aleksandrov nlmsg_end(skb, nlh); 1798cf5bddb9SNikolay Aleksandrov rtnl_notify(skb, net, 0, RTNLGRP_BRVLAN, NULL, GFP_KERNEL); 1799cf5bddb9SNikolay Aleksandrov return; 1800cf5bddb9SNikolay Aleksandrov 1801cf5bddb9SNikolay Aleksandrov out_err: 1802cf5bddb9SNikolay Aleksandrov rtnl_set_sk_err(net, RTNLGRP_BRVLAN, err); 1803cf5bddb9SNikolay Aleksandrov out_kfree: 1804cf5bddb9SNikolay Aleksandrov kfree_skb(skb); 1805cf5bddb9SNikolay Aleksandrov } 1806cf5bddb9SNikolay Aleksandrov 180722f67cdfSVladimir Oltean static int br_vlan_replay_one(struct notifier_block *nb, 180822f67cdfSVladimir Oltean struct net_device *dev, 180922f67cdfSVladimir Oltean struct switchdev_obj_port_vlan *vlan, 181022f67cdfSVladimir Oltean struct netlink_ext_ack *extack) 181122f67cdfSVladimir Oltean { 181222f67cdfSVladimir Oltean struct switchdev_notifier_port_obj_info obj_info = { 181322f67cdfSVladimir Oltean .info = { 181422f67cdfSVladimir Oltean .dev = dev, 181522f67cdfSVladimir Oltean .extack = extack, 181622f67cdfSVladimir Oltean }, 181722f67cdfSVladimir Oltean .obj = &vlan->obj, 181822f67cdfSVladimir Oltean }; 181922f67cdfSVladimir Oltean int err; 182022f67cdfSVladimir Oltean 182122f67cdfSVladimir Oltean err = nb->notifier_call(nb, SWITCHDEV_PORT_OBJ_ADD, &obj_info); 182222f67cdfSVladimir Oltean return notifier_to_errno(err); 182322f67cdfSVladimir Oltean } 182422f67cdfSVladimir Oltean 182522f67cdfSVladimir Oltean int br_vlan_replay(struct net_device *br_dev, struct net_device *dev, 182622f67cdfSVladimir Oltean struct notifier_block *nb, struct netlink_ext_ack *extack) 182722f67cdfSVladimir Oltean { 182822f67cdfSVladimir Oltean struct net_bridge_vlan_group *vg; 182922f67cdfSVladimir Oltean struct net_bridge_vlan *v; 183022f67cdfSVladimir Oltean struct net_bridge_port *p; 183122f67cdfSVladimir Oltean struct net_bridge *br; 183222f67cdfSVladimir Oltean int err = 0; 183322f67cdfSVladimir Oltean u16 pvid; 183422f67cdfSVladimir Oltean 183522f67cdfSVladimir Oltean ASSERT_RTNL(); 183622f67cdfSVladimir Oltean 183722f67cdfSVladimir Oltean if (!netif_is_bridge_master(br_dev)) 183822f67cdfSVladimir Oltean return -EINVAL; 183922f67cdfSVladimir Oltean 184022f67cdfSVladimir Oltean if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) 184122f67cdfSVladimir Oltean return -EINVAL; 184222f67cdfSVladimir Oltean 184322f67cdfSVladimir Oltean if (netif_is_bridge_master(dev)) { 184422f67cdfSVladimir Oltean br = netdev_priv(dev); 184522f67cdfSVladimir Oltean vg = br_vlan_group(br); 184622f67cdfSVladimir Oltean p = NULL; 184722f67cdfSVladimir Oltean } else { 184822f67cdfSVladimir Oltean p = br_port_get_rtnl(dev); 184922f67cdfSVladimir Oltean if (WARN_ON(!p)) 185022f67cdfSVladimir Oltean return -EINVAL; 185122f67cdfSVladimir Oltean vg = nbp_vlan_group(p); 185222f67cdfSVladimir Oltean br = p->br; 185322f67cdfSVladimir Oltean } 185422f67cdfSVladimir Oltean 185522f67cdfSVladimir Oltean if (!vg) 185622f67cdfSVladimir Oltean return 0; 185722f67cdfSVladimir Oltean 185822f67cdfSVladimir Oltean pvid = br_get_pvid(vg); 185922f67cdfSVladimir Oltean 186022f67cdfSVladimir Oltean list_for_each_entry(v, &vg->vlan_list, vlist) { 186122f67cdfSVladimir Oltean struct switchdev_obj_port_vlan vlan = { 186222f67cdfSVladimir Oltean .obj.orig_dev = dev, 186322f67cdfSVladimir Oltean .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN, 186422f67cdfSVladimir Oltean .flags = br_vlan_flags(v, pvid), 186522f67cdfSVladimir Oltean .vid = v->vid, 186622f67cdfSVladimir Oltean }; 186722f67cdfSVladimir Oltean 186822f67cdfSVladimir Oltean if (!br_vlan_should_use(v)) 186922f67cdfSVladimir Oltean continue; 187022f67cdfSVladimir Oltean 1871ad248f77SColin Ian King err = br_vlan_replay_one(nb, dev, &vlan, extack); 187222f67cdfSVladimir Oltean if (err) 187322f67cdfSVladimir Oltean return err; 187422f67cdfSVladimir Oltean } 187522f67cdfSVladimir Oltean 187622f67cdfSVladimir Oltean return err; 187722f67cdfSVladimir Oltean } 187822f67cdfSVladimir Oltean EXPORT_SYMBOL_GPL(br_vlan_replay); 187922f67cdfSVladimir Oltean 18800ab55879SNikolay Aleksandrov /* check if v_curr can enter a range ending in range_end */ 1881a5d29ae2SNikolay Aleksandrov bool br_vlan_can_enter_range(const struct net_bridge_vlan *v_curr, 18820ab55879SNikolay Aleksandrov const struct net_bridge_vlan *range_end) 18830ab55879SNikolay Aleksandrov { 18840ab55879SNikolay Aleksandrov return v_curr->vid - range_end->vid == 1 && 18857a53e718SNikolay Aleksandrov range_end->flags == v_curr->flags && 188699f7c5e0SNikolay Aleksandrov br_vlan_opts_eq_range(v_curr, range_end); 18870ab55879SNikolay Aleksandrov } 18880ab55879SNikolay Aleksandrov 18898dcea187SNikolay Aleksandrov static int br_vlan_dump_dev(const struct net_device *dev, 18908dcea187SNikolay Aleksandrov struct sk_buff *skb, 189156d09976SNikolay Aleksandrov struct netlink_callback *cb, 189256d09976SNikolay Aleksandrov u32 dump_flags) 18938dcea187SNikolay Aleksandrov { 18940ab55879SNikolay Aleksandrov struct net_bridge_vlan *v, *range_start = NULL, *range_end = NULL; 189556d09976SNikolay Aleksandrov bool dump_stats = !!(dump_flags & BRIDGE_VLANDB_DUMPF_STATS); 18968dcea187SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 18978dcea187SNikolay Aleksandrov int idx = 0, s_idx = cb->args[1]; 18988dcea187SNikolay Aleksandrov struct nlmsghdr *nlh = NULL; 18998dcea187SNikolay Aleksandrov struct net_bridge_port *p; 19008dcea187SNikolay Aleksandrov struct br_vlan_msg *bvm; 19018dcea187SNikolay Aleksandrov struct net_bridge *br; 19028dcea187SNikolay Aleksandrov int err = 0; 19038dcea187SNikolay Aleksandrov u16 pvid; 19048dcea187SNikolay Aleksandrov 19058dcea187SNikolay Aleksandrov if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) 19068dcea187SNikolay Aleksandrov return -EINVAL; 19078dcea187SNikolay Aleksandrov 19088dcea187SNikolay Aleksandrov if (netif_is_bridge_master(dev)) { 19098dcea187SNikolay Aleksandrov br = netdev_priv(dev); 19108dcea187SNikolay Aleksandrov vg = br_vlan_group_rcu(br); 19118dcea187SNikolay Aleksandrov p = NULL; 19128dcea187SNikolay Aleksandrov } else { 19138dcea187SNikolay Aleksandrov p = br_port_get_rcu(dev); 19148dcea187SNikolay Aleksandrov if (WARN_ON(!p)) 19158dcea187SNikolay Aleksandrov return -EINVAL; 19168dcea187SNikolay Aleksandrov vg = nbp_vlan_group_rcu(p); 19178dcea187SNikolay Aleksandrov br = p->br; 19188dcea187SNikolay Aleksandrov } 19198dcea187SNikolay Aleksandrov 19208dcea187SNikolay Aleksandrov if (!vg) 19218dcea187SNikolay Aleksandrov return 0; 19228dcea187SNikolay Aleksandrov 19238dcea187SNikolay Aleksandrov nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, 19248dcea187SNikolay Aleksandrov RTM_NEWVLAN, sizeof(*bvm), NLM_F_MULTI); 19258dcea187SNikolay Aleksandrov if (!nlh) 19268dcea187SNikolay Aleksandrov return -EMSGSIZE; 19278dcea187SNikolay Aleksandrov bvm = nlmsg_data(nlh); 19288dcea187SNikolay Aleksandrov memset(bvm, 0, sizeof(*bvm)); 19298dcea187SNikolay Aleksandrov bvm->family = PF_BRIDGE; 19308dcea187SNikolay Aleksandrov bvm->ifindex = dev->ifindex; 19318dcea187SNikolay Aleksandrov pvid = br_get_pvid(vg); 19328dcea187SNikolay Aleksandrov 19330ab55879SNikolay Aleksandrov /* idx must stay at range's beginning until it is filled in */ 19348dcea187SNikolay Aleksandrov list_for_each_entry_rcu(v, &vg->vlan_list, vlist) { 19358dcea187SNikolay Aleksandrov if (!br_vlan_should_use(v)) 19368dcea187SNikolay Aleksandrov continue; 19370ab55879SNikolay Aleksandrov if (idx < s_idx) { 19380ab55879SNikolay Aleksandrov idx++; 19390ab55879SNikolay Aleksandrov continue; 19400ab55879SNikolay Aleksandrov } 19410ab55879SNikolay Aleksandrov 19420ab55879SNikolay Aleksandrov if (!range_start) { 19430ab55879SNikolay Aleksandrov range_start = v; 19440ab55879SNikolay Aleksandrov range_end = v; 19450ab55879SNikolay Aleksandrov continue; 19460ab55879SNikolay Aleksandrov } 19470ab55879SNikolay Aleksandrov 194856d09976SNikolay Aleksandrov if (dump_stats || v->vid == pvid || 194956d09976SNikolay Aleksandrov !br_vlan_can_enter_range(v, range_end)) { 195056d09976SNikolay Aleksandrov u16 vlan_flags = br_vlan_flags(range_start, pvid); 19510ab55879SNikolay Aleksandrov 19520ab55879SNikolay Aleksandrov if (!br_vlan_fill_vids(skb, range_start->vid, 19537a53e718SNikolay Aleksandrov range_end->vid, range_start, 195456d09976SNikolay Aleksandrov vlan_flags, dump_stats)) { 19558dcea187SNikolay Aleksandrov err = -EMSGSIZE; 19568dcea187SNikolay Aleksandrov break; 19578dcea187SNikolay Aleksandrov } 19580ab55879SNikolay Aleksandrov /* advance number of filled vlans */ 19590ab55879SNikolay Aleksandrov idx += range_end->vid - range_start->vid + 1; 19600ab55879SNikolay Aleksandrov 19610ab55879SNikolay Aleksandrov range_start = v; 19628dcea187SNikolay Aleksandrov } 19630ab55879SNikolay Aleksandrov range_end = v; 19640ab55879SNikolay Aleksandrov } 19650ab55879SNikolay Aleksandrov 19660ab55879SNikolay Aleksandrov /* err will be 0 and range_start will be set in 3 cases here: 19670ab55879SNikolay Aleksandrov * - first vlan (range_start == range_end) 19680ab55879SNikolay Aleksandrov * - last vlan (range_start == range_end, not in range) 19690ab55879SNikolay Aleksandrov * - last vlan range (range_start != range_end, in range) 19700ab55879SNikolay Aleksandrov */ 19710ab55879SNikolay Aleksandrov if (!err && range_start && 19720ab55879SNikolay Aleksandrov !br_vlan_fill_vids(skb, range_start->vid, range_end->vid, 197356d09976SNikolay Aleksandrov range_start, br_vlan_flags(range_start, pvid), 197456d09976SNikolay Aleksandrov dump_stats)) 19750ab55879SNikolay Aleksandrov err = -EMSGSIZE; 19760ab55879SNikolay Aleksandrov 19770ab55879SNikolay Aleksandrov cb->args[1] = err ? idx : 0; 19780ab55879SNikolay Aleksandrov 19798dcea187SNikolay Aleksandrov nlmsg_end(skb, nlh); 19808dcea187SNikolay Aleksandrov 19818dcea187SNikolay Aleksandrov return err; 19828dcea187SNikolay Aleksandrov } 19838dcea187SNikolay Aleksandrov 198456d09976SNikolay Aleksandrov static const struct nla_policy br_vlan_db_dump_pol[BRIDGE_VLANDB_DUMP_MAX + 1] = { 198556d09976SNikolay Aleksandrov [BRIDGE_VLANDB_DUMP_FLAGS] = { .type = NLA_U32 }, 198656d09976SNikolay Aleksandrov }; 198756d09976SNikolay Aleksandrov 19888dcea187SNikolay Aleksandrov static int br_vlan_rtm_dump(struct sk_buff *skb, struct netlink_callback *cb) 19898dcea187SNikolay Aleksandrov { 199056d09976SNikolay Aleksandrov struct nlattr *dtb[BRIDGE_VLANDB_DUMP_MAX + 1]; 19918dcea187SNikolay Aleksandrov int idx = 0, err = 0, s_idx = cb->args[0]; 19928dcea187SNikolay Aleksandrov struct net *net = sock_net(skb->sk); 19938dcea187SNikolay Aleksandrov struct br_vlan_msg *bvm; 19948dcea187SNikolay Aleksandrov struct net_device *dev; 199556d09976SNikolay Aleksandrov u32 dump_flags = 0; 19968dcea187SNikolay Aleksandrov 199756d09976SNikolay Aleksandrov err = nlmsg_parse(cb->nlh, sizeof(*bvm), dtb, BRIDGE_VLANDB_DUMP_MAX, 199856d09976SNikolay Aleksandrov br_vlan_db_dump_pol, cb->extack); 19998dcea187SNikolay Aleksandrov if (err < 0) 20008dcea187SNikolay Aleksandrov return err; 20018dcea187SNikolay Aleksandrov 20028dcea187SNikolay Aleksandrov bvm = nlmsg_data(cb->nlh); 200356d09976SNikolay Aleksandrov if (dtb[BRIDGE_VLANDB_DUMP_FLAGS]) 200456d09976SNikolay Aleksandrov dump_flags = nla_get_u32(dtb[BRIDGE_VLANDB_DUMP_FLAGS]); 20058dcea187SNikolay Aleksandrov 20068dcea187SNikolay Aleksandrov rcu_read_lock(); 20078dcea187SNikolay Aleksandrov if (bvm->ifindex) { 20088dcea187SNikolay Aleksandrov dev = dev_get_by_index_rcu(net, bvm->ifindex); 20098dcea187SNikolay Aleksandrov if (!dev) { 20108dcea187SNikolay Aleksandrov err = -ENODEV; 20118dcea187SNikolay Aleksandrov goto out_err; 20128dcea187SNikolay Aleksandrov } 201356d09976SNikolay Aleksandrov err = br_vlan_dump_dev(dev, skb, cb, dump_flags); 20148dcea187SNikolay Aleksandrov if (err && err != -EMSGSIZE) 20158dcea187SNikolay Aleksandrov goto out_err; 20168dcea187SNikolay Aleksandrov } else { 20178dcea187SNikolay Aleksandrov for_each_netdev_rcu(net, dev) { 20188dcea187SNikolay Aleksandrov if (idx < s_idx) 20198dcea187SNikolay Aleksandrov goto skip; 20208dcea187SNikolay Aleksandrov 202156d09976SNikolay Aleksandrov err = br_vlan_dump_dev(dev, skb, cb, dump_flags); 20228dcea187SNikolay Aleksandrov if (err == -EMSGSIZE) 20238dcea187SNikolay Aleksandrov break; 20248dcea187SNikolay Aleksandrov skip: 20258dcea187SNikolay Aleksandrov idx++; 20268dcea187SNikolay Aleksandrov } 20278dcea187SNikolay Aleksandrov } 20288dcea187SNikolay Aleksandrov cb->args[0] = idx; 20298dcea187SNikolay Aleksandrov rcu_read_unlock(); 20308dcea187SNikolay Aleksandrov 20318dcea187SNikolay Aleksandrov return skb->len; 20328dcea187SNikolay Aleksandrov 20338dcea187SNikolay Aleksandrov out_err: 20348dcea187SNikolay Aleksandrov rcu_read_unlock(); 20358dcea187SNikolay Aleksandrov 20368dcea187SNikolay Aleksandrov return err; 20378dcea187SNikolay Aleksandrov } 20388dcea187SNikolay Aleksandrov 2039f26b2965SNikolay Aleksandrov static const struct nla_policy br_vlan_db_policy[BRIDGE_VLANDB_ENTRY_MAX + 1] = { 20408140860cSJohannes Berg [BRIDGE_VLANDB_ENTRY_INFO] = 20418140860cSJohannes Berg NLA_POLICY_EXACT_LEN(sizeof(struct bridge_vlan_info)), 20420ab55879SNikolay Aleksandrov [BRIDGE_VLANDB_ENTRY_RANGE] = { .type = NLA_U16 }, 2043a580c76dSNikolay Aleksandrov [BRIDGE_VLANDB_ENTRY_STATE] = { .type = NLA_U8 }, 2044fa388f29SNikolay Aleksandrov [BRIDGE_VLANDB_ENTRY_TUNNEL_INFO] = { .type = NLA_NESTED }, 2045f26b2965SNikolay Aleksandrov }; 2046f26b2965SNikolay Aleksandrov 2047f26b2965SNikolay Aleksandrov static int br_vlan_rtm_process_one(struct net_device *dev, 2048f26b2965SNikolay Aleksandrov const struct nlattr *attr, 2049f26b2965SNikolay Aleksandrov int cmd, struct netlink_ext_ack *extack) 2050f26b2965SNikolay Aleksandrov { 20510ab55879SNikolay Aleksandrov struct bridge_vlan_info *vinfo, vrange_end, *vinfo_last = NULL; 2052f26b2965SNikolay Aleksandrov struct nlattr *tb[BRIDGE_VLANDB_ENTRY_MAX + 1]; 2053a5d29ae2SNikolay Aleksandrov bool changed = false, skip_processing = false; 2054f26b2965SNikolay Aleksandrov struct net_bridge_vlan_group *vg; 2055f26b2965SNikolay Aleksandrov struct net_bridge_port *p = NULL; 2056f26b2965SNikolay Aleksandrov int err = 0, cmdmap = 0; 2057f26b2965SNikolay Aleksandrov struct net_bridge *br; 2058f26b2965SNikolay Aleksandrov 2059f26b2965SNikolay Aleksandrov if (netif_is_bridge_master(dev)) { 2060f26b2965SNikolay Aleksandrov br = netdev_priv(dev); 2061f26b2965SNikolay Aleksandrov vg = br_vlan_group(br); 2062f26b2965SNikolay Aleksandrov } else { 2063f26b2965SNikolay Aleksandrov p = br_port_get_rtnl(dev); 2064f26b2965SNikolay Aleksandrov if (WARN_ON(!p)) 2065f26b2965SNikolay Aleksandrov return -ENODEV; 2066f26b2965SNikolay Aleksandrov br = p->br; 2067f26b2965SNikolay Aleksandrov vg = nbp_vlan_group(p); 2068f26b2965SNikolay Aleksandrov } 2069f26b2965SNikolay Aleksandrov 2070f26b2965SNikolay Aleksandrov if (WARN_ON(!vg)) 2071f26b2965SNikolay Aleksandrov return -ENODEV; 2072f26b2965SNikolay Aleksandrov 2073f26b2965SNikolay Aleksandrov err = nla_parse_nested(tb, BRIDGE_VLANDB_ENTRY_MAX, attr, 2074f26b2965SNikolay Aleksandrov br_vlan_db_policy, extack); 2075f26b2965SNikolay Aleksandrov if (err) 2076f26b2965SNikolay Aleksandrov return err; 2077f26b2965SNikolay Aleksandrov 2078f26b2965SNikolay Aleksandrov if (!tb[BRIDGE_VLANDB_ENTRY_INFO]) { 2079f26b2965SNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Missing vlan entry info"); 2080f26b2965SNikolay Aleksandrov return -EINVAL; 2081f26b2965SNikolay Aleksandrov } 20820ab55879SNikolay Aleksandrov memset(&vrange_end, 0, sizeof(vrange_end)); 2083f26b2965SNikolay Aleksandrov 2084f26b2965SNikolay Aleksandrov vinfo = nla_data(tb[BRIDGE_VLANDB_ENTRY_INFO]); 2085f26b2965SNikolay Aleksandrov if (vinfo->flags & (BRIDGE_VLAN_INFO_RANGE_BEGIN | 2086f26b2965SNikolay Aleksandrov BRIDGE_VLAN_INFO_RANGE_END)) { 2087f26b2965SNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Old-style vlan ranges are not allowed when using RTM vlan calls"); 2088f26b2965SNikolay Aleksandrov return -EINVAL; 2089f26b2965SNikolay Aleksandrov } 2090f26b2965SNikolay Aleksandrov if (!br_vlan_valid_id(vinfo->vid, extack)) 2091f26b2965SNikolay Aleksandrov return -EINVAL; 2092f26b2965SNikolay Aleksandrov 20930ab55879SNikolay Aleksandrov if (tb[BRIDGE_VLANDB_ENTRY_RANGE]) { 20940ab55879SNikolay Aleksandrov vrange_end.vid = nla_get_u16(tb[BRIDGE_VLANDB_ENTRY_RANGE]); 20950ab55879SNikolay Aleksandrov /* validate user-provided flags without RANGE_BEGIN */ 20960ab55879SNikolay Aleksandrov vrange_end.flags = BRIDGE_VLAN_INFO_RANGE_END | vinfo->flags; 20970ab55879SNikolay Aleksandrov vinfo->flags |= BRIDGE_VLAN_INFO_RANGE_BEGIN; 20980ab55879SNikolay Aleksandrov 20990ab55879SNikolay Aleksandrov /* vinfo_last is the range start, vinfo the range end */ 21000ab55879SNikolay Aleksandrov vinfo_last = vinfo; 21010ab55879SNikolay Aleksandrov vinfo = &vrange_end; 21020ab55879SNikolay Aleksandrov 21030ab55879SNikolay Aleksandrov if (!br_vlan_valid_id(vinfo->vid, extack) || 21040ab55879SNikolay Aleksandrov !br_vlan_valid_range(vinfo, vinfo_last, extack)) 21050ab55879SNikolay Aleksandrov return -EINVAL; 21060ab55879SNikolay Aleksandrov } 21070ab55879SNikolay Aleksandrov 2108f26b2965SNikolay Aleksandrov switch (cmd) { 2109f26b2965SNikolay Aleksandrov case RTM_NEWVLAN: 2110f26b2965SNikolay Aleksandrov cmdmap = RTM_SETLINK; 2111a5d29ae2SNikolay Aleksandrov skip_processing = !!(vinfo->flags & BRIDGE_VLAN_INFO_ONLY_OPTS); 2112f26b2965SNikolay Aleksandrov break; 2113adb3ce9bSNikolay Aleksandrov case RTM_DELVLAN: 2114adb3ce9bSNikolay Aleksandrov cmdmap = RTM_DELLINK; 2115adb3ce9bSNikolay Aleksandrov break; 2116f26b2965SNikolay Aleksandrov } 2117f26b2965SNikolay Aleksandrov 2118a5d29ae2SNikolay Aleksandrov if (!skip_processing) { 2119a5d29ae2SNikolay Aleksandrov struct bridge_vlan_info *tmp_last = vinfo_last; 2120a5d29ae2SNikolay Aleksandrov 2121a5d29ae2SNikolay Aleksandrov /* br_process_vlan_info may overwrite vinfo_last */ 2122a5d29ae2SNikolay Aleksandrov err = br_process_vlan_info(br, p, cmdmap, vinfo, &tmp_last, 2123a5d29ae2SNikolay Aleksandrov &changed, extack); 2124a5d29ae2SNikolay Aleksandrov 2125a5d29ae2SNikolay Aleksandrov /* notify first if anything changed */ 2126f26b2965SNikolay Aleksandrov if (changed) 2127f26b2965SNikolay Aleksandrov br_ifinfo_notify(cmdmap, br, p); 2128f26b2965SNikolay Aleksandrov 2129a5d29ae2SNikolay Aleksandrov if (err) 2130a5d29ae2SNikolay Aleksandrov return err; 2131a5d29ae2SNikolay Aleksandrov } 2132a5d29ae2SNikolay Aleksandrov 2133a5d29ae2SNikolay Aleksandrov /* deal with options */ 2134a5d29ae2SNikolay Aleksandrov if (cmd == RTM_NEWVLAN) { 2135a5d29ae2SNikolay Aleksandrov struct net_bridge_vlan *range_start, *range_end; 2136a5d29ae2SNikolay Aleksandrov 2137a5d29ae2SNikolay Aleksandrov if (vinfo_last) { 2138a5d29ae2SNikolay Aleksandrov range_start = br_vlan_find(vg, vinfo_last->vid); 2139a5d29ae2SNikolay Aleksandrov range_end = br_vlan_find(vg, vinfo->vid); 2140a5d29ae2SNikolay Aleksandrov } else { 2141a5d29ae2SNikolay Aleksandrov range_start = br_vlan_find(vg, vinfo->vid); 2142a5d29ae2SNikolay Aleksandrov range_end = range_start; 2143a5d29ae2SNikolay Aleksandrov } 2144a5d29ae2SNikolay Aleksandrov 2145a5d29ae2SNikolay Aleksandrov err = br_vlan_process_options(br, p, range_start, range_end, 2146a5d29ae2SNikolay Aleksandrov tb, extack); 2147a5d29ae2SNikolay Aleksandrov } 2148a5d29ae2SNikolay Aleksandrov 2149f26b2965SNikolay Aleksandrov return err; 2150f26b2965SNikolay Aleksandrov } 2151f26b2965SNikolay Aleksandrov 2152f26b2965SNikolay Aleksandrov static int br_vlan_rtm_process(struct sk_buff *skb, struct nlmsghdr *nlh, 2153f26b2965SNikolay Aleksandrov struct netlink_ext_ack *extack) 2154f26b2965SNikolay Aleksandrov { 2155f26b2965SNikolay Aleksandrov struct net *net = sock_net(skb->sk); 2156f26b2965SNikolay Aleksandrov struct br_vlan_msg *bvm; 2157f26b2965SNikolay Aleksandrov struct net_device *dev; 2158f26b2965SNikolay Aleksandrov struct nlattr *attr; 2159f26b2965SNikolay Aleksandrov int err, vlans = 0; 2160f26b2965SNikolay Aleksandrov int rem; 2161f26b2965SNikolay Aleksandrov 2162f26b2965SNikolay Aleksandrov /* this should validate the header and check for remaining bytes */ 2163f26b2965SNikolay Aleksandrov err = nlmsg_parse(nlh, sizeof(*bvm), NULL, BRIDGE_VLANDB_MAX, NULL, 2164f26b2965SNikolay Aleksandrov extack); 2165f26b2965SNikolay Aleksandrov if (err < 0) 2166f26b2965SNikolay Aleksandrov return err; 2167f26b2965SNikolay Aleksandrov 2168f26b2965SNikolay Aleksandrov bvm = nlmsg_data(nlh); 2169f26b2965SNikolay Aleksandrov dev = __dev_get_by_index(net, bvm->ifindex); 2170f26b2965SNikolay Aleksandrov if (!dev) 2171f26b2965SNikolay Aleksandrov return -ENODEV; 2172f26b2965SNikolay Aleksandrov 2173f26b2965SNikolay Aleksandrov if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) { 2174f26b2965SNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "The device is not a valid bridge or bridge port"); 2175f26b2965SNikolay Aleksandrov return -EINVAL; 2176f26b2965SNikolay Aleksandrov } 2177f26b2965SNikolay Aleksandrov 2178f26b2965SNikolay Aleksandrov nlmsg_for_each_attr(attr, nlh, sizeof(*bvm), rem) { 2179f26b2965SNikolay Aleksandrov if (nla_type(attr) != BRIDGE_VLANDB_ENTRY) 2180f26b2965SNikolay Aleksandrov continue; 2181f26b2965SNikolay Aleksandrov 2182f26b2965SNikolay Aleksandrov vlans++; 2183f26b2965SNikolay Aleksandrov err = br_vlan_rtm_process_one(dev, attr, nlh->nlmsg_type, 2184f26b2965SNikolay Aleksandrov extack); 2185f26b2965SNikolay Aleksandrov if (err) 2186f26b2965SNikolay Aleksandrov break; 2187f26b2965SNikolay Aleksandrov } 2188f26b2965SNikolay Aleksandrov if (!vlans) { 2189f26b2965SNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "No vlans found to process"); 2190f26b2965SNikolay Aleksandrov err = -EINVAL; 2191f26b2965SNikolay Aleksandrov } 2192f26b2965SNikolay Aleksandrov 2193f26b2965SNikolay Aleksandrov return err; 2194f26b2965SNikolay Aleksandrov } 2195f26b2965SNikolay Aleksandrov 21968dcea187SNikolay Aleksandrov void br_vlan_rtnl_init(void) 21978dcea187SNikolay Aleksandrov { 21988dcea187SNikolay Aleksandrov rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_GETVLAN, NULL, 21998dcea187SNikolay Aleksandrov br_vlan_rtm_dump, 0); 2200f26b2965SNikolay Aleksandrov rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_NEWVLAN, 2201f26b2965SNikolay Aleksandrov br_vlan_rtm_process, NULL, 0); 2202adb3ce9bSNikolay Aleksandrov rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_DELVLAN, 2203adb3ce9bSNikolay Aleksandrov br_vlan_rtm_process, NULL, 0); 22048dcea187SNikolay Aleksandrov } 22058dcea187SNikolay Aleksandrov 22068dcea187SNikolay Aleksandrov void br_vlan_rtnl_uninit(void) 22078dcea187SNikolay Aleksandrov { 22088dcea187SNikolay Aleksandrov rtnl_unregister(PF_BRIDGE, RTM_GETVLAN); 2209f26b2965SNikolay Aleksandrov rtnl_unregister(PF_BRIDGE, RTM_NEWVLAN); 2210adb3ce9bSNikolay Aleksandrov rtnl_unregister(PF_BRIDGE, RTM_DELVLAN); 22118dcea187SNikolay Aleksandrov } 2212