From: "hongbo.wang" <hongbo.w...@nxp.com>

the following command will be supported:

Set bridge's vlan protocol:
    ip link set br0 type bridge vlan_protocol 802.1ad
Add VLAN:
    ip link add link swp1 name swp1.100 type vlan protocol 802.1ad id 100
Delete VLAN:
    ip link del link swp1 name swp1.100

Signed-off-by: hongbo.wang <hongbo.w...@nxp.com>
---
 include/net/switchdev.h |  1 +
 net/dsa/dsa_priv.h      |  4 ++--
 net/dsa/port.c          |  6 ++++--
 net/dsa/slave.c         | 27 +++++++++++++++++++++------
 net/dsa/tag_8021q.c     |  4 ++--
 5 files changed, 30 insertions(+), 12 deletions(-)

diff --git a/include/net/switchdev.h b/include/net/switchdev.h
index ff2246914301..7594ea82879f 100644
--- a/include/net/switchdev.h
+++ b/include/net/switchdev.h
@@ -97,6 +97,7 @@ struct switchdev_obj_port_vlan {
        u16 flags;
        u16 vid_begin;
        u16 vid_end;
+       u16 proto;
 };
 
 #define SWITCHDEV_OBJ_PORT_VLAN(OBJ) \
diff --git a/net/dsa/dsa_priv.h b/net/dsa/dsa_priv.h
index 1653e3377cb3..52685b9875e5 100644
--- a/net/dsa/dsa_priv.h
+++ b/net/dsa/dsa_priv.h
@@ -164,8 +164,8 @@ int dsa_port_vlan_add(struct dsa_port *dp,
                      struct switchdev_trans *trans);
 int dsa_port_vlan_del(struct dsa_port *dp,
                      const struct switchdev_obj_port_vlan *vlan);
-int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 flags);
-int dsa_port_vid_del(struct dsa_port *dp, u16 vid);
+int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 proto, u16 flags);
+int dsa_port_vid_del(struct dsa_port *dp, u16 vid, u16 proto);
 int dsa_port_link_register_of(struct dsa_port *dp);
 void dsa_port_link_unregister_of(struct dsa_port *dp);
 extern const struct phylink_mac_ops dsa_port_phylink_mac_ops;
diff --git a/net/dsa/port.c b/net/dsa/port.c
index e23ece229c7e..c98bbac3980a 100644
--- a/net/dsa/port.c
+++ b/net/dsa/port.c
@@ -433,13 +433,14 @@ int dsa_port_vlan_del(struct dsa_port *dp,
        return dsa_port_notify(dp, DSA_NOTIFIER_VLAN_DEL, &info);
 }
 
-int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 flags)
+int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 proto, u16 flags)
 {
        struct switchdev_obj_port_vlan vlan = {
                .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
                .flags = flags,
                .vid_begin = vid,
                .vid_end = vid,
+               .proto = proto,
        };
        struct switchdev_trans trans;
        int err;
@@ -454,12 +455,13 @@ int dsa_port_vid_add(struct dsa_port *dp, u16 vid, u16 
flags)
 }
 EXPORT_SYMBOL(dsa_port_vid_add);
 
-int dsa_port_vid_del(struct dsa_port *dp, u16 vid)
+int dsa_port_vid_del(struct dsa_port *dp, u16 vid, u16 proto)
 {
        struct switchdev_obj_port_vlan vlan = {
                .obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
                .vid_begin = vid,
                .vid_end = vid,
+               .proto = proto,
        };
 
        return dsa_port_vlan_del(dp, &vlan);
diff --git a/net/dsa/slave.c b/net/dsa/slave.c
index 41d60eeefdbd..2a03da92af0a 100644
--- a/net/dsa/slave.c
+++ b/net/dsa/slave.c
@@ -1233,7 +1233,10 @@ static int dsa_slave_vlan_rx_add_vid(struct net_device 
*dev, __be16 proto,
                                     u16 vid)
 {
        struct dsa_port *dp = dsa_slave_to_port(dev);
+       u16 vlan_proto = ntohs(proto);
        struct bridge_vlan_info info;
+       bool change_proto = false;
+       u16 br_proto = 0;
        int ret;
 
        /* Check for a possible bridge VLAN entry now since there is no
@@ -1243,20 +1246,24 @@ static int dsa_slave_vlan_rx_add_vid(struct net_device 
*dev, __be16 proto,
                if (dsa_port_skip_vlan_configuration(dp))
                        return 0;
 
+               ret = br_vlan_get_proto(dp->bridge_dev, &br_proto);
+               if (ret == 0 && br_proto != vlan_proto)
+                       change_proto = true;
+
                /* br_vlan_get_info() returns -EINVAL or -ENOENT if the
                 * device, respectively the VID is not found, returning
                 * 0 means success, which is a failure for us here.
                 */
                ret = br_vlan_get_info(dp->bridge_dev, vid, &info);
-               if (ret == 0)
+               if (ret == 0 && !change_proto)
                        return -EBUSY;
        }
 
-       ret = dsa_port_vid_add(dp, vid, 0);
+       ret = dsa_port_vid_add(dp, vid, vlan_proto, 0);
        if (ret)
                return ret;
 
-       ret = dsa_port_vid_add(dp->cpu_dp, vid, 0);
+       ret = dsa_port_vid_add(dp->cpu_dp, vid, 0, 0);
        if (ret)
                return ret;
 
@@ -1267,7 +1274,10 @@ static int dsa_slave_vlan_rx_kill_vid(struct net_device 
*dev, __be16 proto,
                                      u16 vid)
 {
        struct dsa_port *dp = dsa_slave_to_port(dev);
+       u16 vlan_proto = ntohs(proto);
        struct bridge_vlan_info info;
+       bool change_proto = false;
+       u16 br_proto = 0;
        int ret;
 
        /* Check for a possible bridge VLAN entry now since there is no
@@ -1277,19 +1287,23 @@ static int dsa_slave_vlan_rx_kill_vid(struct net_device 
*dev, __be16 proto,
                if (dsa_port_skip_vlan_configuration(dp))
                        return 0;
 
+               ret = br_vlan_get_proto(dp->bridge_dev, &br_proto);
+               if (ret == 0 && br_proto != vlan_proto)
+                       change_proto = true;
+
                /* br_vlan_get_info() returns -EINVAL or -ENOENT if the
                 * device, respectively the VID is not found, returning
                 * 0 means success, which is a failure for us here.
                 */
                ret = br_vlan_get_info(dp->bridge_dev, vid, &info);
-               if (ret == 0)
+               if (ret == 0 && !change_proto)
                        return -EBUSY;
        }
 
        /* Do not deprogram the CPU port as it may be shared with other user
         * ports which can be members of this VLAN as well.
         */
-       return dsa_port_vid_del(dp, vid);
+       return dsa_port_vid_del(dp, vid, vlan_proto);
 }
 
 struct dsa_hw_port {
@@ -1744,7 +1758,8 @@ int dsa_slave_create(struct dsa_port *port)
 
        slave_dev->features = master->vlan_features | NETIF_F_HW_TC;
        if (ds->ops->port_vlan_add && ds->ops->port_vlan_del)
-               slave_dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
+               slave_dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER |
+                                      NETIF_F_HW_VLAN_STAG_FILTER;
        slave_dev->hw_features |= NETIF_F_HW_TC;
        slave_dev->features |= NETIF_F_LLTX;
        slave_dev->ethtool_ops = &dsa_slave_ethtool_ops;
diff --git a/net/dsa/tag_8021q.c b/net/dsa/tag_8021q.c
index 780b2a15ac9b..848f85ed5c0f 100644
--- a/net/dsa/tag_8021q.c
+++ b/net/dsa/tag_8021q.c
@@ -152,9 +152,9 @@ static int dsa_8021q_vid_apply(struct dsa_switch *ds, int 
port, u16 vid,
        struct dsa_port *dp = dsa_to_port(ds, port);
 
        if (enabled)
-               return dsa_port_vid_add(dp, vid, flags);
+               return dsa_port_vid_add(dp, vid, 0, flags);
 
-       return dsa_port_vid_del(dp, vid);
+       return dsa_port_vid_del(dp, vid, 0);
 }
 
 /* RX VLAN tagging (left) and TX VLAN tagging (right) setup shown for a single
-- 
2.17.1

Reply via email to