1 files changed, 310 insertions, 5 deletions

diff --git a/drivers/infiniband/hw/mlx5/mad.c b/drivers/infiniband/hw/mlx5/mad.c
index 9cf9a37bb5ff..b84d13a487cc 100644
--- a/drivers/infiniband/hw/mlx5/mad.c
+++ b/drivers/infiniband/hw/mlx5/mad.c
@@ -41,8 +41,8 @@ enum {
 };
 
 int mlx5_MAD_IFC(struct mlx5_ib_dev *dev, int ignore_mkey, int ignore_bkey,
-                 u8 port, struct ib_wc *in_wc, struct ib_grh *in_grh,
-                 void *in_mad, void *response_mad)
+                 u8 port, const struct ib_wc *in_wc, const struct ib_grh *in_grh,
+                 const void *in_mad, void *response_mad)
 {
         u8 op_modifier = 0;
 
@@ -58,11 +58,19 @@ int mlx5_MAD_IFC(struct mlx5_ib_dev *dev, int ignore_mkey, int ignore_bkey,
 }
 
 int mlx5_ib_process_mad(struct ib_device *ibdev, int mad_flags, u8 port_num,
-                        struct ib_wc *in_wc, struct ib_grh *in_grh,
-                        struct ib_mad *in_mad, struct ib_mad *out_mad)
+                        const struct ib_wc *in_wc, const struct ib_grh *in_grh,
+                        const struct ib_mad_hdr *in, size_t in_mad_size,
+                        struct ib_mad_hdr *out, size_t *out_mad_size,
+                        u16 *out_mad_pkey_index)
 {
         u16 slid;
         int err;
+        const struct ib_mad *in_mad = (const struct ib_mad *)in;
+        struct ib_mad *out_mad = (struct ib_mad *)out;
+
+        if (WARN_ON_ONCE(in_mad_size != sizeof(*in_mad) ||
+                         *out_mad_size != sizeof(*out_mad)))
+                return IB_MAD_RESULT_FAILURE;
 
         slid = in_wc ? in_wc->slid : be16_to_cpu(IB_LID_PERMISSIVE);
 
@@ -129,7 +137,7 @@ int mlx5_query_ext_port_caps(struct mlx5_ib_dev *dev, u8 port)
 
         packet_error = be16_to_cpu(out_mad->status);
 
-        dev->mdev->caps.gen.ext_port_cap[port - 1] = (!err && !packet_error) ?
+        dev->mdev->port_caps[port - 1].ext_port_cap = (!err && !packet_error) ?
                 MLX_EXT_PORT_CAP_FLAG_EXTENDED_PORT_INFO : 0;
 
 out:
@@ -137,3 +145,300 @@ out:
         kfree(out_mad);
         return err;
 }
+
+int mlx5_query_mad_ifc_smp_attr_node_info(struct ib_device *ibdev,
+                                          struct ib_smp *out_mad)
+{
+        struct ib_smp *in_mad = NULL;
+        int err = -ENOMEM;
+
+        in_mad = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        if (!in_mad)
+                return -ENOMEM;
+
+        init_query_mad(in_mad);
+        in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
+
+        err = mlx5_MAD_IFC(to_mdev(ibdev), 1, 1, 1, NULL, NULL, in_mad,
+                           out_mad);
+
+        kfree(in_mad);
+        return err;
+}
+
+int mlx5_query_mad_ifc_system_image_guid(struct ib_device *ibdev,
+                                         __be64 *sys_image_guid)
+{
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!out_mad)
+                return -ENOMEM;
+
+        err = mlx5_query_mad_ifc_smp_attr_node_info(ibdev, out_mad);
+        if (err)
+                goto out;
+
+        memcpy(sys_image_guid, out_mad->data + 4, 8);
+
+out:
+        kfree(out_mad);
+
+        return err;
+}
+
+int mlx5_query_mad_ifc_max_pkeys(struct ib_device *ibdev,
+                                 u16 *max_pkeys)
+{
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!out_mad)
+                return -ENOMEM;
+
+        err = mlx5_query_mad_ifc_smp_attr_node_info(ibdev, out_mad);
+        if (err)
+                goto out;
+
+        *max_pkeys = be16_to_cpup((__be16 *)(out_mad->data + 28));
+
+out:
+        kfree(out_mad);
+
+        return err;
+}
+
+int mlx5_query_mad_ifc_vendor_id(struct ib_device *ibdev,
+                                 u32 *vendor_id)
+{
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!out_mad)
+                return -ENOMEM;
+
+        err = mlx5_query_mad_ifc_smp_attr_node_info(ibdev, out_mad);
+        if (err)
+                goto out;
+
+        *vendor_id = be32_to_cpup((__be32 *)(out_mad->data + 36)) & 0xffff;
+
+out:
+        kfree(out_mad);
+
+        return err;
+}
+
+int mlx5_query_mad_ifc_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
+{
+        struct ib_smp *in_mad  = NULL;
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        in_mad  = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!in_mad || !out_mad)
+                goto out;
+
+        init_query_mad(in_mad);
+        in_mad->attr_id = IB_SMP_ATTR_NODE_DESC;
+
+        err = mlx5_MAD_IFC(dev, 1, 1, 1, NULL, NULL, in_mad, out_mad);
+        if (err)
+                goto out;
+
+        memcpy(node_desc, out_mad->data, 64);
+out:
+        kfree(in_mad);
+        kfree(out_mad);
+        return err;
+}
+
+int mlx5_query_mad_ifc_node_guid(struct mlx5_ib_dev *dev, __be64 *node_guid)
+{
+        struct ib_smp *in_mad  = NULL;
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        in_mad  = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!in_mad || !out_mad)
+                goto out;
+
+        init_query_mad(in_mad);
+        in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
+
+        err = mlx5_MAD_IFC(dev, 1, 1, 1, NULL, NULL, in_mad, out_mad);
+        if (err)
+                goto out;
+
+        memcpy(node_guid, out_mad->data + 12, 8);
+out:
+        kfree(in_mad);
+        kfree(out_mad);
+        return err;
+}
+
+int mlx5_query_mad_ifc_pkey(struct ib_device *ibdev, u8 port, u16 index,
+                            u16 *pkey)
+{
+        struct ib_smp *in_mad  = NULL;
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        in_mad  = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!in_mad || !out_mad)
+                goto out;
+
+        init_query_mad(in_mad);
+        in_mad->attr_id  = IB_SMP_ATTR_PKEY_TABLE;
+        in_mad->attr_mod = cpu_to_be32(index / 32);
+
+        err = mlx5_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad,
+                           out_mad);
+        if (err)
+                goto out;
+
+        *pkey = be16_to_cpu(((__be16 *)out_mad->data)[index % 32]);
+
+out:
+        kfree(in_mad);
+        kfree(out_mad);
+        return err;
+}
+
+int mlx5_query_mad_ifc_gids(struct ib_device *ibdev, u8 port, int index,
+                            union ib_gid *gid)
+{
+        struct ib_smp *in_mad  = NULL;
+        struct ib_smp *out_mad = NULL;
+        int err = -ENOMEM;
+
+        in_mad  = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!in_mad || !out_mad)
+                goto out;
+
+        init_query_mad(in_mad);
+        in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
+        in_mad->attr_mod = cpu_to_be32(port);
+
+        err = mlx5_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad,
+                           out_mad);
+        if (err)
+                goto out;
+
+        memcpy(gid->raw, out_mad->data + 8, 8);
+
+        init_query_mad(in_mad);
+        in_mad->attr_id  = IB_SMP_ATTR_GUID_INFO;
+        in_mad->attr_mod = cpu_to_be32(index / 8);
+
+        err = mlx5_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad,
+                           out_mad);
+        if (err)
+                goto out;
+
+        memcpy(gid->raw + 8, out_mad->data + (index % 8) * 8, 8);
+
+out:
+        kfree(in_mad);
+        kfree(out_mad);
+        return err;
+}
+
+int mlx5_query_mad_ifc_port(struct ib_device *ibdev, u8 port,
+                            struct ib_port_attr *props)
+{
+        struct mlx5_ib_dev *dev = to_mdev(ibdev);
+        struct mlx5_core_dev *mdev = dev->mdev;
+        struct ib_smp *in_mad  = NULL;
+        struct ib_smp *out_mad = NULL;
+        int ext_active_speed;
+        int err = -ENOMEM;
+
+        if (port < 1 || port > MLX5_CAP_GEN(mdev, num_ports)) {
+                mlx5_ib_warn(dev, "invalid port number %d\n", port);
+                return -EINVAL;
+        }
+
+        in_mad  = kzalloc(sizeof(*in_mad), GFP_KERNEL);
+        out_mad = kmalloc(sizeof(*out_mad), GFP_KERNEL);
+        if (!in_mad || !out_mad)
+                goto out;
+
+        memset(props, 0, sizeof(*props));
+
+        init_query_mad(in_mad);
+        in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
+        in_mad->attr_mod = cpu_to_be32(port);
+
+        err = mlx5_MAD_IFC(dev, 1, 1, port, NULL, NULL, in_mad, out_mad);
+        if (err) {
+                mlx5_ib_warn(dev, "err %d\n", err);
+                goto out;
+        }
+
+        props->lid              = be16_to_cpup((__be16 *)(out_mad->data + 16));
+        props->lmc              = out_mad->data[34] & 0x7;
+        props->sm_lid           = be16_to_cpup((__be16 *)(out_mad->data + 18));
+        props->sm_sl            = out_mad->data[36] & 0xf;
+        props->state            = out_mad->data[32] & 0xf;
+        props->phys_state       = out_mad->data[33] >> 4;
+        props->port_cap_flags   = be32_to_cpup((__be32 *)(out_mad->data + 20));
+        props->gid_tbl_len      = out_mad->data[50];
+        props->max_msg_sz       = 1 << MLX5_CAP_GEN(mdev, log_max_msg);
+        props->pkey_tbl_len     = mdev->port_caps[port - 1].pkey_table_len;
+        props->bad_pkey_cntr    = be16_to_cpup((__be16 *)(out_mad->data + 46));
+        props->qkey_viol_cntr   = be16_to_cpup((__be16 *)(out_mad->data + 48));
+        props->active_width     = out_mad->data[31] & 0xf;
+        props->active_speed     = out_mad->data[35] >> 4;
+        props->max_mtu          = out_mad->data[41] & 0xf;
+        props->active_mtu       = out_mad->data[36] >> 4;
+        props->subnet_timeout   = out_mad->data[51] & 0x1f;
+        props->max_vl_num       = out_mad->data[37] >> 4;
+        props->init_type_reply  = out_mad->data[41] >> 4;
+
+        /* Check if extended speeds (EDR/FDR/...) are supported */
+        if (props->port_cap_flags & IB_PORT_EXTENDED_SPEEDS_SUP) {
+                ext_active_speed = out_mad->data[62] >> 4;
+
+                switch (ext_active_speed) {
+                case 1:
+                        props->active_speed = 16; /* FDR */
+                        break;
+                case 2:
+                        props->active_speed = 32; /* EDR */
+                        break;
+                }
+        }
+
+        /* If reported active speed is QDR, check if is FDR-10 */
+        if (props->active_speed == 4) {
+                if (mdev->port_caps[port - 1].ext_port_cap &
+                    MLX_EXT_PORT_CAP_FLAG_EXTENDED_PORT_INFO) {
+                        init_query_mad(in_mad);
+                        in_mad->attr_id = MLX5_ATTR_EXTENDED_PORT_INFO;
+                        in_mad->attr_mod = cpu_to_be32(port);
+
+                        err = mlx5_MAD_IFC(dev, 1, 1, port,
+                                           NULL, NULL, in_mad, out_mad);
+                        if (err)
+                                goto out;
+
+                        /* Checking LinkSpeedActive for FDR-10 */
+                        if (out_mad->data[15] & 0x1)
+                                props->active_speed = 8;
+                }
+        }
+
+out:
+        kfree(in_mad);
+        kfree(out_mad);
+
+        return err;
+}