Use mailbox to get device capability for initializing driver capability.

Co-developed-by: Xin Guo <redacted>
Signed-off-by: Xin Guo <redacted>
Co-developed-by: Zhu Yikai <redacted>
Signed-off-by: Zhu Yikai <redacted>
Signed-off-by: Fan Gong <gongfan1@huawei.com>
---
  .../ethernet/huawei/hinic3/hinic3_hw_cfg.c    | 66 +++++++++++++++++++
  .../ethernet/huawei/hinic3/hinic3_hw_cfg.h    |  1 +
  .../ethernet/huawei/hinic3/hinic3_hw_intf.h   | 42 ++++++++++++
  .../net/ethernet/huawei/hinic3/hinic3_hwdev.c |  6 ++
  4 files changed, 115 insertions(+)

diff --git a/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.c b/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.c
index e7ef450c4971..24b929690f64 100644
--- a/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.c
+++ b/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.c

@@ -8,6 +8,67 @@
  #include "hinic3_hwif.h"
  #include "hinic3_mbox.h"
  
+#define HINIC3_CFG_MAX_QP  256
+
+static void parse_pub_res_cap(struct hinic3_hwdev *hwdev,
+			      struct hinic3_dev_cap *cap,
+			      const struct cfg_cmd_dev_cap *dev_cap,
+			      enum hinic3_func_type type)
+{
+	cap->port_id = dev_cap->port_id;
+	cap->supp_svcs_bitmap = dev_cap->svc_cap_en;
+}
+
+static void parse_l2nic_res_cap(struct hinic3_hwdev *hwdev,
+				struct hinic3_dev_cap *cap,
+				const struct cfg_cmd_dev_cap *dev_cap,
+				enum hinic3_func_type type)
+{
+	struct hinic3_nic_service_cap *nic_svc_cap = &cap->nic_svc_cap;
+
+	nic_svc_cap->max_sqs = min(dev_cap->nic_max_sq_id + 1,
+				   HINIC3_CFG_MAX_QP);
+}
+
+static void parse_dev_cap(struct hinic3_hwdev *hwdev,
+			  const struct cfg_cmd_dev_cap *dev_cap,
+			  enum hinic3_func_type type)
+{
+	struct hinic3_dev_cap *cap = &hwdev->cfg_mgmt->cap;
+
+	/* Public resource */
+	parse_pub_res_cap(hwdev, cap, dev_cap, type);
+
+	/* L2 NIC resource */
+	if (hinic3_support_nic(hwdev))
+		parse_l2nic_res_cap(hwdev, cap, dev_cap, type);
+}

+
+static int get_cap_from_fw(struct hinic3_hwdev *hwdev,
+			   enum hinic3_func_type type)
+{
+	struct mgmt_msg_params msg_params = {};
+	struct cfg_cmd_dev_cap dev_cap = {};
+	int err;
+
+	dev_cap.func_id = hinic3_global_func_id(hwdev);
+
+	mgmt_msg_params_init_default(&msg_params, &dev_cap, sizeof(dev_cap));
+
+	err = hinic3_send_mbox_to_mgmt(hwdev, MGMT_MOD_CFGM,
+				       CFG_CMD_GET_DEV_CAP, &msg_params);
+	if (err || dev_cap.head.status) {
+		dev_err(hwdev->dev,
+			"Failed to get capability from FW, err: %d, status: 0x%x\n",
+			err, dev_cap.head.status);
+		return -EIO;
+	}
+
+	parse_dev_cap(hwdev, &dev_cap, type);
+
+	return 0;
+}
+
  static int hinic3_init_irq_info(struct hinic3_hwdev *hwdev)
  {
  	struct hinic3_cfg_mgmt_info *cfg_mgmt = hwdev->cfg_mgmt;

@@ -180,6 +241,11 @@ void hinic3_free_irq(struct hinic3_hwdev *hwdev, u32 irq_id)
  	mutex_unlock(&irq_info->irq_mutex);
  }
  
+int init_capability(struct hinic3_hwdev *hwdev)
+{
+	return get_cap_from_fw(hwdev, HINIC3_FUNC_TYPE_VF);
+}
+
  bool hinic3_support_nic(struct hinic3_hwdev *hwdev)
  {
  	return hwdev->cfg_mgmt->cap.supp_svcs_bitmap &

diff --git a/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.h b/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.h
index 5978cbd56fb2..8900b40e3c42 100644
--- a/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.h
+++ b/drivers/net/ethernet/huawei/hinic3/hinic3_hw_cfg.h

@@ -49,6 +49,7 @@ int hinic3_alloc_irqs(struct hinic3_hwdev *hwdev, u16 num,
  		      struct msix_entry *alloc_arr, u16 *act_num);
  void hinic3_free_irq(struct hinic3_hwdev *hwdev, u32 irq_id);
  
+int init_capability(struct hinic3_hwdev *hwdev);