net/mlx4_core: Respond to operation request by firmware

This commit adds new firmware command and new firmware event.  The firmware
raises the MLX4_EVENT_TYPE_OP_REQUIRED event in order to signal the driver it
needs to perform an administrative operation throughout the MLX4_CMD_GET_OP_REQ
command. At the moment the supported operation is adding/removing multicast
entries which are used by the firmware for handling NCSI traffic in B0
steering mode.

Also, had to swap the order of mlx4_init_mcg_table() and
mlx4_init_eq_table() to make sure that driver will get events only after
resources are initialized to handle it.

Signed-off-by: Yevgeny Petrilin <yevgenyp@mellanox.com>
Signed-off-by: Jack Morgenstein <jackm@dev.mellanox.com>
Signed-off-by: Eugenia Emantayev <eugenia@mellanox.com>
Signed-off-by: Amir Vadai <amirv@mellanox.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

9 files changed, 166 insertions, 27 deletions

diff --git a/drivers/net/ethernet/mellanox/mlx4/cmd.c b/drivers/net/ethernet/mellanox/mlx4/cmd.c
index 299d0184f983..141322c31ae9 100644
--- a/drivers/net/ethernet/mellanox/mlx4/cmd.c
+++ b/drivers/net/ethernet/mellanox/mlx4/cmd.c
@@ -809,6 +809,15 @@ int MLX4_CMD_UPDATE_QP_wrapper(struct mlx4_dev *dev, int slave,
         return -EPERM;
 }
 
+int MLX4_CMD_GET_OP_REQ_wrapper(struct mlx4_dev *dev, int slave,
+                     struct mlx4_vhcr *vhcr,
+                     struct mlx4_cmd_mailbox *inbox,
+                     struct mlx4_cmd_mailbox *outbox,
+                     struct mlx4_cmd_info *cmd)
+{
+        return -EPERM;
+}
+
 int mlx4_DMA_wrapper(struct mlx4_dev *dev, int slave,
                      struct mlx4_vhcr *vhcr,
                      struct mlx4_cmd_mailbox *inbox,
@@ -1252,6 +1261,15 @@ static struct mlx4_cmd_info cmd_info[] = {
                 .wrapper = MLX4_CMD_UPDATE_QP_wrapper
         },
         {
+                .opcode = MLX4_CMD_GET_OP_REQ,
+                .has_inbox = false,
+                .has_outbox = false,
+                .out_is_imm = false,
+                .encode_slave_id = false,
+                .verify = NULL,
+                .wrapper = MLX4_CMD_GET_OP_REQ_wrapper,
+        },
+        {
                 .opcode = MLX4_CMD_CONF_SPECIAL_QP,
                 .has_inbox = false,
                 .has_outbox = false,
diff --git a/drivers/net/ethernet/mellanox/mlx4/eq.c b/drivers/net/ethernet/mellanox/mlx4/eq.c
index 7e042869ef0c..0416c5b3b35c 100644
--- a/drivers/net/ethernet/mellanox/mlx4/eq.c
+++ b/drivers/net/ethernet/mellanox/mlx4/eq.c
@@ -79,6 +79,7 @@ enum {
                                (1ull << MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE)    | \
                                (1ull << MLX4_EVENT_TYPE_SRQ_LIMIT)          | \
                                (1ull << MLX4_EVENT_TYPE_CMD)                | \
+                               (1ull << MLX4_EVENT_TYPE_OP_REQUIRED)        | \
                                (1ull << MLX4_EVENT_TYPE_COMM_CHANNEL)       | \
                                (1ull << MLX4_EVENT_TYPE_FLR_EVENT)          | \
                                (1ull << MLX4_EVENT_TYPE_FATAL_WARNING))
@@ -629,6 +630,14 @@ static int mlx4_eq_int(struct mlx4_dev *dev, struct mlx4_eq *eq)
                         mlx4_warn(dev, "EQ overrun on EQN %d\n", eq->eqn);
                         break;
 
+                case MLX4_EVENT_TYPE_OP_REQUIRED:
+                        atomic_inc(&priv->opreq_count);
+                        /* FW commands can't be executed from interrupt context
+                         * working in deferred task
+                         */
+                        queue_work(mlx4_wq, &priv->opreq_task);
+                        break;
+
                 case MLX4_EVENT_TYPE_COMM_CHANNEL:
                         if (!mlx4_is_master(dev)) {
                                 mlx4_warn(dev, "Received comm channel event "
diff --git a/drivers/net/ethernet/mellanox/mlx4/fw.c b/drivers/net/ethernet/mellanox/mlx4/fw.c
index 8873d6802c80..aec6f5802da5 100644
--- a/drivers/net/ethernet/mellanox/mlx4/fw.c
+++ b/drivers/net/ethernet/mellanox/mlx4/fw.c
@@ -1705,3 +1705,107 @@ int mlx4_wol_write(struct mlx4_dev *dev, u64 config, int port)
                         MLX4_CMD_TIME_CLASS_A, MLX4_CMD_NATIVE);
 }
 EXPORT_SYMBOL_GPL(mlx4_wol_write);
+
+enum {
+        ADD_TO_MCG = 0x26,
+};
+
+
+void mlx4_opreq_action(struct work_struct *work)
+{
+        struct mlx4_priv *priv = container_of(work, struct mlx4_priv,
+                                              opreq_task);
+        struct mlx4_dev *dev = &priv->dev;
+        int num_tasks = atomic_read(&priv->opreq_count);
+        struct mlx4_cmd_mailbox *mailbox;
+        struct mlx4_mgm *mgm;
+        u32 *outbox;
+        u32 modifier;
+        u16 token;
+        u16 type_m;
+        u16 type;
+        int err;
+        u32 num_qps;
+        struct mlx4_qp qp;
+        int i;
+        u8 rem_mcg;
+        u8 prot;
+
+#define GET_OP_REQ_MODIFIER_OFFSET      0x08
+#define GET_OP_REQ_TOKEN_OFFSET         0x14
+#define GET_OP_REQ_TYPE_OFFSET          0x1a
+#define GET_OP_REQ_DATA_OFFSET          0x20
+
+        mailbox = mlx4_alloc_cmd_mailbox(dev);
+        if (IS_ERR(mailbox)) {
+                mlx4_err(dev, "Failed to allocate mailbox for GET_OP_REQ\n");
+                return;
+        }
+        outbox = mailbox->buf;
+
+        while (num_tasks) {
+                err = mlx4_cmd_box(dev, 0, mailbox->dma, 0, 0,
+                                   MLX4_CMD_GET_OP_REQ, MLX4_CMD_TIME_CLASS_A,
+                                   MLX4_CMD_NATIVE);
+                if (err) {
+                        mlx4_err(dev, "Failed to retreive required operation: %d\n",
+                                 err);
+                        return;
+                }
+                MLX4_GET(modifier, outbox, GET_OP_REQ_MODIFIER_OFFSET);
+                MLX4_GET(token, outbox, GET_OP_REQ_TOKEN_OFFSET);
+                MLX4_GET(type, outbox, GET_OP_REQ_TYPE_OFFSET);
+                type_m = type >> 12;
+                type &= 0xfff;
+
+                switch (type) {
+                case ADD_TO_MCG:
+                        if (dev->caps.steering_mode ==
+                            MLX4_STEERING_MODE_DEVICE_MANAGED) {
+                                mlx4_warn(dev, "ADD MCG operation is not supported in DEVICE_MANAGED steering mode\n");
+                                err = EPERM;
+                                break;
+                        }
+                        mgm = (struct mlx4_mgm *)((u8 *)(outbox) +
+                                                  GET_OP_REQ_DATA_OFFSET);
+                        num_qps = be32_to_cpu(mgm->members_count) &
+                                  MGM_QPN_MASK;
+                        rem_mcg = ((u8 *)(&mgm->members_count))[0] & 1;
+                        prot = ((u8 *)(&mgm->members_count))[0] >> 6;
+
+                        for (i = 0; i < num_qps; i++) {
+                                qp.qpn = be32_to_cpu(mgm->qp[i]);
+                                if (rem_mcg)
+                                        err = mlx4_multicast_detach(dev, &qp,
+                                                                    mgm->gid,
+                                                                    prot, 0);
+                                else
+                                        err = mlx4_multicast_attach(dev, &qp,
+                                                                    mgm->gid,
+                                                                    mgm->gid[5]
+                                                                    , 0, prot,
+                                                                    NULL);
+                                if (err)
+                                        break;
+                        }
+                        break;
+                default:
+                        mlx4_warn(dev, "Bad type for required operation\n");
+                        err = EINVAL;
+                        break;
+                }