net/mlx4: Add VF MAC spoof checking support

Add ndo_set_vf_spoofchk support

Signed-off-by: Rony Efraim <ronye@mellanox.com>
Signed-off-by: Or Gerlitz <ogerlitz@mellanox.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

4 files changed, 59 insertions, 0 deletions

diff --git a/drivers/net/ethernet/mellanox/mlx4/cmd.c b/drivers/net/ethernet/mellanox/mlx4/cmd.c
index aad6f8dbfb4c..eda347eeb5dc 100644
--- a/drivers/net/ethernet/mellanox/mlx4/cmd.c
+++ b/drivers/net/ethernet/mellanox/mlx4/cmd.c
@@ -1514,6 +1514,21 @@ static int mlx4_master_activate_admin_state(struct mlx4_priv *priv, int slave)
                                  (int)(vp_oper->state.default_vlan),
                                  vp_oper->vlan_idx, slave, port);
                 }
+                if (vp_admin->spoofchk) {
+                        vp_oper->mac_idx = __mlx4_register_mac(&priv->dev,
+                                                               port,
+                                                               vp_admin->mac);
+                        if (0 > vp_oper->mac_idx) {
+                                err = vp_oper->mac_idx;
+                                vp_oper->mac_idx = NO_INDX;
+                                mlx4_warn((&priv->dev),
+                                          "No mac resorces slave %d, port %d\n",
+                                          slave, port);
+                                return err;
+                        }
+                        mlx4_dbg((&(priv->dev)), "alloc mac %llx idx  %d slave %d port %d\n",
+                                 vp_oper->state.mac, vp_oper->mac_idx, slave, port);
+                }
         }
         return 0;
 }
@@ -1530,6 +1545,10 @@ static void mlx4_master_deactivate_admin_state(struct mlx4_priv *priv, int slave
                                                port, vp_oper->vlan_idx);
                         vp_oper->vlan_idx = NO_INDX;
                 }
+                if (NO_INDX != vp_oper->mac_idx) {
+                        __mlx4_unregister_mac(&priv->dev, port, vp_oper->mac_idx);
+                        vp_oper->mac_idx = NO_INDX;
+                }
         }
         return;
 }
@@ -2111,3 +2130,24 @@ int mlx4_set_vf_vlan(struct mlx4_dev *dev, int port, int vf, u16 vlan, u8 qos)
         return 0;
 }
 EXPORT_SYMBOL_GPL(mlx4_set_vf_vlan);
+
+int mlx4_set_vf_spoofchk(struct mlx4_dev *dev, int port, int vf, bool setting)
+{
+        struct mlx4_priv *priv = mlx4_priv(dev);
+        struct mlx4_vport_state *s_info;
+        int slave;
+
+        if ((!mlx4_is_master(dev)) ||
+            !(dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_FSM))
+                return -EPROTONOSUPPORT;
+
+        slave = mlx4_get_slave_indx(dev, vf);
+        if (slave < 0)
+                return -EINVAL;
+
+        s_info = &priv->mfunc.master.vf_admin[slave].vport[port];
+        s_info->spoofchk = setting;
+
+        return 0;
+}
+EXPORT_SYMBOL_GPL(mlx4_set_vf_spoofchk);
diff --git a/drivers/net/ethernet/mellanox/mlx4/en_netdev.c b/drivers/net/ethernet/mellanox/mlx4/en_netdev.c
index c1f2c5b34d95..8d197b41242e 100644
--- a/drivers/net/ethernet/mellanox/mlx4/en_netdev.c
+++ b/drivers/net/ethernet/mellanox/mlx4/en_netdev.c
@@ -2044,6 +2044,14 @@ static int mlx4_en_set_vf_vlan(struct net_device *dev, int vf, u16 vlan, u8 qos)
         return mlx4_set_vf_vlan(mdev->dev, en_priv->port, vf, vlan, qos);
 }
 
+static int mlx4_en_set_vf_spoofchk(struct net_device *dev, int vf, bool setting)
+{
+        struct mlx4_en_priv *en_priv = netdev_priv(dev);
+        struct mlx4_en_dev *mdev = en_priv->mdev;
+
+        return mlx4_set_vf_spoofchk(mdev->dev, en_priv->port, vf, setting);
+}
+
 
 static const struct net_device_ops mlx4_netdev_ops = {
         .ndo_open               = mlx4_en_open,
@@ -2084,6 +2092,7 @@ static const struct net_device_ops mlx4_netdev_ops_master = {
         .ndo_vlan_rx_kill_vid   = mlx4_en_vlan_rx_kill_vid,
         .ndo_set_vf_mac         = mlx4_en_set_vf_mac,
         .ndo_set_vf_vlan        = mlx4_en_set_vf_vlan,
+        .ndo_set_vf_spoofchk    = mlx4_en_set_vf_spoofchk,
 #ifdef CONFIG_NET_POLL_CONTROLLER
         .ndo_poll_controller    = mlx4_en_netpoll,
 #endif
diff --git a/drivers/net/ethernet/mellanox/mlx4/fw.c b/drivers/net/ethernet/mellanox/mlx4/fw.c
index d2d30c940790..b147bdd40768 100644
--- a/drivers/net/ethernet/mellanox/mlx4/fw.c
+++ b/drivers/net/ethernet/mellanox/mlx4/fw.c
@@ -659,6 +659,8 @@ int mlx4_QUERY_DEV_CAP(struct mlx4_dev *dev, struct mlx4_dev_cap *dev_cap)
         MLX4_GET(field32, outbox, QUERY_DEV_CAP_EXT_2_FLAGS_OFFSET);
         if (field32 & (1 << 26))
                 dev_cap->flags2 |= MLX4_DEV_CAP_FLAG2_VLAN_CONTROL;
+        if (field32 & (1 << 20))
+                dev_cap->flags2 |= MLX4_DEV_CAP_FLAG2_FSM;
 
         if (dev->flags & MLX4_FLAG_OLD_PORT_CMDS) {
                 for (i = 1; i <= dev_cap->num_ports; ++i) {
diff --git a/drivers/net/ethernet/mellanox/mlx4/resource_tracker.c b/drivers/net/ethernet/mellanox/mlx4/resource_tracker.c
index 5083d4babfe3..e12e0d2e0ee0 100644
--- a/drivers/net/ethernet/mellanox/mlx4/resource_tracker.c
+++ b/drivers/net/ethernet/mellanox/mlx4/resource_tracker.c
@@ -383,6 +383,14 @@ static int update_vport_qp_param(struct mlx4_dev *dev,
                          vp_oper->vlan_idx, (int)(qpc->pri_path.feup),
                          (int)(qpc->pri_path.fl));
         }
+        if (vp_oper->state.spoofchk) {
+                qpc->pri_path.feup |= 1 << 5; /* set fsm bit */;
+                qpc->pri_path.grh_mylmc = (0x80 & qpc->pri_path.grh_mylmc) + vp_oper->mac_idx;
+                mlx4_dbg(dev, "spoof qp %d  port %d feup  0x%x, myLmc 0x%x mindx %d\n",
+                         be32_to_cpu(qpc->local_qpn) & 0xffffff, port,
+                         (int)qpc->pri_path.feup, (int)qpc->pri_path.grh_mylmc,
+                         vp_oper->mac_idx);
+        }
         return 0;
 }