net: make vid as a parameter for ndo_fdb_add/ndo_fdb_del

Do the work of parsing NDA_VLAN directly in rtnetlink code, pass simple
u16 vid to drivers from there.

Signed-off-by: Jiri Pirko <jiri@resnulli.us>
Acked-by: Andy Gospodarek <gospo@cumulusnetworks.com>
Acked-by: Jamal Hadi Salim <jhs@mojatatu.com>
Acked-by: John Fastabend <john.r.fastabend@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

1 files changed, 43 insertions, 7 deletions

diff --git a/net/core/rtnetlink.c b/net/core/rtnetlink.c
index b9b7dfaf202b..1a233c1c8ab4 100644
--- a/net/core/rtnetlink.c
+++ b/net/core/rtnetlink.c
@@ -36,6 +36,7 @@
 #include <linux/mutex.h>
 #include <linux/if_addr.h>
 #include <linux/if_bridge.h>
+#include <linux/if_vlan.h>
 #include <linux/pci.h>
 #include <linux/etherdevice.h>
 
@@ -2312,7 +2313,7 @@ errout:
 int ndo_dflt_fdb_add(struct ndmsg *ndm,
                      struct nlattr *tb[],
                      struct net_device *dev,
-                     const unsigned char *addr,
+                     const unsigned char *addr, u16 vid,
                      u16 flags)
 {
         int err = -EINVAL;
@@ -2338,6 +2339,28 @@ int ndo_dflt_fdb_add(struct ndmsg *ndm,
 }
 EXPORT_SYMBOL(ndo_dflt_fdb_add);
 
+static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid)
+{
+        u16 vid = 0;
+
+        if (vlan_attr) {
+                if (nla_len(vlan_attr) != sizeof(u16)) {
+                        pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan\n");
+                        return -EINVAL;
+                }
+
+                vid = nla_get_u16(vlan_attr);
+
+                if (!vid || vid >= VLAN_VID_MASK) {
+                        pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan id %d\n",
+                                vid);
+                        return -EINVAL;
+                }
+        }
+        *p_vid = vid;
+        return 0;
+}
+
 static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh)
 {
         struct net *net = sock_net(skb->sk);
@@ -2345,6 +2368,7 @@ static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh)
         struct nlattr *tb[NDA_MAX+1];
         struct net_device *dev;
         u8 *addr;
+        u16 vid;
         int err;
 
         err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL);
@@ -2370,6 +2394,10 @@ static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh)
 
         addr = nla_data(tb[NDA_LLADDR]);
 
+        err = fdb_vid_parse(tb[NDA_VLAN], &vid);
+        if (err)
+                return err;
+
         err = -EOPNOTSUPP;
 
         /* Support fdb on master device the net/bridge default case */
@@ -2378,7 +2406,8 @@ static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh)
                 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
                 const struct net_device_ops *ops = br_dev->netdev_ops;
 
-                err = ops->ndo_fdb_add(ndm, tb, dev, addr, nlh->nlmsg_flags);
+                err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid,
+                                       nlh->nlmsg_flags);
                 if (err)
                         goto out;
                 else
@@ -2389,9 +2418,10 @@ static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh)
         if ((ndm->ndm_flags & NTF_SELF)) {
                 if (dev->netdev_ops->ndo_fdb_add)
                         err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr,
+                                                           vid,
                                                            nlh->nlmsg_flags);
                 else
-                        err = ndo_dflt_fdb_add(ndm, tb, dev, addr,
+                        err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid,
                                                nlh->nlmsg_flags);
 
                 if (!err) {
@@ -2409,7 +2439,7 @@ out:
 int ndo_dflt_fdb_del(struct ndmsg *ndm,
                      struct nlattr *tb[],
                      struct net_device *dev,
-                     const unsigned char *addr)
+                     const unsigned char *addr, u16 vid)
 {
         int err = -EINVAL;
 
@@ -2438,6 +2468,7 @@ static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh)
         struct net_device *dev;
         int err = -EINVAL;
         __u8 *addr;
+        u16 vid;
 
         if (!netlink_capable(skb, CAP_NET_ADMIN))
                 return -EPERM;
@@ -2465,6 +2496,10 @@ static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh)
 
         addr = nla_data(tb[NDA_LLADDR]);
 
+        err = fdb_vid_parse(tb[NDA_VLAN], &vid);
+        if (err)
+                return err;
+
         err = -EOPNOTSUPP;
 
         /* Support fdb on master device the net/bridge default case */
@@ -2474,7 +2509,7 @@ static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh)
                 const struct net_device_ops *ops = br_dev->netdev_ops;
 
                 if (ops->ndo_fdb_del)
-                        err = ops->ndo_fdb_del(ndm, tb, dev, addr);
+                        err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid);
 
                 if (err)
                         goto out;
@@ -2485,9 +2520,10 @@ static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh)
         /* Embedded bridge, macvlan, and any other device support */
         if (ndm->ndm_flags & NTF_SELF) {
                 if (dev->netdev_ops->ndo_fdb_del)
-                        err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr);
+                        err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr,
+                                                           vid);
                 else
-                        err = ndo_dflt_fdb_del(ndm, tb, dev, addr);
+                        err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid);
 
                 if (!err) {
                         rtnl_fdb_notify(dev, addr, RTM_DELNEIGH);