drivers/net/ethernet/hisilicon/hns3/hns3pf/hclge_mbx.c - linux - Git at Google

 // SPDX-License-Identifier: GPL-2.0+
 // Copyright (c) 2016-2017 Hisilicon Limited.

 #include "hclge_main.h"
 #include "hclge_mbx.h"
 #include "hnae3.h"

 /* hclge_gen_resp_to_vf: used to generate a synchronous response to VF when PF
  * receives a mailbox message from VF.
  * @vport: pointer to struct hclge_vport
  * @vf_to_pf_req: pointer to hclge_mbx_vf_to_pf_cmd of the original mailbox
  *		  message
  * @resp_status: indicate to VF whether its request success(0) or failed.
  */
 static int hclge_gen_resp_to_vf(struct hclge_vport *vport,
 				struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req,
 				int resp_status,
 				u8 *resp_data, u16 resp_data_len)
 {
 	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
 	struct hclge_dev *hdev = vport->back;
 	enum hclge_cmd_status status;
 	struct hclge_desc desc;

 	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;

 	if (resp_data_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) {
 		dev_err(&hdev->pdev->dev,
 			"PF fail to gen resp to VF len %d exceeds max len %d\n",
 			resp_data_len,
 			HCLGE_MBX_MAX_RESP_DATA_SIZE);
 	}

 	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);

 	resp_pf_to_vf->dest_vfid = vf_to_pf_req->mbx_src_vfid;
 	resp_pf_to_vf->msg_len = vf_to_pf_req->msg_len;

 	resp_pf_to_vf->msg[0] = HCLGE_MBX_PF_VF_RESP;
 	resp_pf_to_vf->msg[1] = vf_to_pf_req->msg[0];
 	resp_pf_to_vf->msg[2] = vf_to_pf_req->msg[1];
 	resp_pf_to_vf->msg[3] = (resp_status == 0) ? 0 : 1;

 	if (resp_data && resp_data_len > 0)
 		memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len);

 	status = hclge_cmd_send(&hdev->hw, &desc, 1);
 	if (status)
 		dev_err(&hdev->pdev->dev,
 			"PF failed(=%d) to send response to VF\n", status);

 	return status;
 }

 static int hclge_send_mbx_msg(struct hclge_vport *vport, u8 *msg, u16 msg_len,
 			      u16 mbx_opcode, u8 dest_vfid)
 {
 	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
 	struct hclge_dev *hdev = vport->back;
 	enum hclge_cmd_status status;
 	struct hclge_desc desc;

 	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;

 	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);

 	resp_pf_to_vf->dest_vfid = dest_vfid;
 	resp_pf_to_vf->msg_len = msg_len;
 	resp_pf_to_vf->msg[0] = mbx_opcode;

 	memcpy(&resp_pf_to_vf->msg[1], msg, msg_len);

 	status = hclge_cmd_send(&hdev->hw, &desc, 1);
 	if (status)
 		dev_err(&hdev->pdev->dev,
 			"PF failed(=%d) to send mailbox message to VF\n",
 			status);

 	return status;
 }

 static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
 {
 	struct hnae3_ring_chain_node *chain_tmp, *chain;

 	chain = head->next;

 	while (chain) {
 		chain_tmp = chain->next;
 		kzfree(chain);
 		chain = chain_tmp;
 	}
 }

 /* hclge_get_ring_chain_from_mbx: get ring type & tqpid from mailbox message
  * msg[0]: opcode
  * msg[1]: <not relevant to this function>
  * msg[2]: ring_num
  * msg[3]: first ring type (TX|RX)
  * msg[4]: first tqp id
  * msg[5] ~ msg[14]: other ring type and tqp id
  */
 static int hclge_get_ring_chain_from_mbx(
 			struct hclge_mbx_vf_to_pf_cmd *req,
 			struct hnae3_ring_chain_node *ring_chain,
 			struct hclge_vport *vport)
 {
 #define HCLGE_RING_NODE_VARIABLE_NUM		3
 #define HCLGE_RING_MAP_MBX_BASIC_MSG_NUM	3
 	struct hnae3_ring_chain_node *cur_chain, *new_chain;
 	int ring_num;
 	int i;

 	ring_num = req->msg[2];

 	hnae_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
 	ring_chain->tqp_index =
 			hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);

 	cur_chain = ring_chain;

 	for (i = 1; i < ring_num; i++) {
 		new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
 		if (!new_chain)
 			goto err;

 		hnae_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
 			     req->msg[HCLGE_RING_NODE_VARIABLE_NUM * i +
 			     HCLGE_RING_MAP_MBX_BASIC_MSG_NUM]);

 		new_chain->tqp_index =
 		hclge_get_queue_id(vport->nic.kinfo.tqp
 			[req->msg[HCLGE_RING_NODE_VARIABLE_NUM * i +
 			HCLGE_RING_MAP_MBX_BASIC_MSG_NUM + 1]]);

 		cur_chain->next = new_chain;
 		cur_chain = new_chain;
 	}

 	return 0;
 err:
 	hclge_free_vector_ring_chain(ring_chain);
 	return -ENOMEM;
 }

 static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
 					     struct hclge_mbx_vf_to_pf_cmd *req)
 {
 	struct hnae3_ring_chain_node ring_chain;
 	int vector_id = req->msg[1];
 	int ret;

 	memset(&ring_chain, 0, sizeof(ring_chain));
 	ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
 	if (ret)
 		return ret;

 	ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
 	if (ret)
 		return ret;

 	hclge_free_vector_ring_chain(&ring_chain);

 	return 0;
 }

 static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
 				     struct hclge_mbx_vf_to_pf_cmd *req)
 {
 	bool en = req->msg[1] ? true : false;
 	struct hclge_promisc_param param;

 	/* always enable broadcast promisc bit */
 	hclge_promisc_param_init(&param, en, en, true, vport->vport_id);
 	return hclge_cmd_set_promisc_mode(vport->back, &param);
 }

 static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
 				    struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 				    bool gen_resp)
 {
 	const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 	struct hclge_dev *hdev = vport->back;
 	int status;

 	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
 		const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]);

 		hclge_rm_uc_addr_common(vport, old_addr);
 		status = hclge_add_uc_addr_common(vport, mac_addr);
 	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
 		status = hclge_add_uc_addr_common(vport, mac_addr);
 	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
 		status = hclge_rm_uc_addr_common(vport, mac_addr);
 	} else {
 		dev_err(&hdev->pdev->dev,
 			"failed to set unicast mac addr, unknown subcode %d\n",
 			mbx_req->msg[1]);
 		return -EIO;
 	}

 	if (gen_resp)
 		hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

 	return 0;
 }

 static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
 				    struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 				    bool gen_resp)
 {
 	const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 	struct hclge_dev *hdev = vport->back;
 	int status;

 	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
 		status = hclge_add_mc_addr_common(vport, mac_addr);
 	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
 		status = hclge_rm_mc_addr_common(vport, mac_addr);
 	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_FUNC_MTA_ENABLE) {
 		u8 func_id = vport->vport_id;
 		bool enable = mbx_req->msg[2];

 		status = hclge_cfg_func_mta_filter(hdev, func_id, enable);
 	} else {
 		dev_err(&hdev->pdev->dev,
 			"failed to set mcast mac addr, unknown subcode %d\n",
 			mbx_req->msg[1]);
 		return -EIO;
 	}

 	if (gen_resp)
 		hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

 	return 0;
 }

 static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
 				 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 				 bool gen_resp)
 {
 	struct hclge_dev *hdev = vport->back;
 	int status = 0;

 	if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) {
 		u16 vlan, proto;
 		bool is_kill;

 		is_kill = !!mbx_req->msg[2];
 		memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan));
 		memcpy(&proto, &mbx_req->msg[5], sizeof(proto));
 		status = hclge_set_vf_vlan_common(hdev, vport->vport_id,
 						  is_kill, vlan, 0,
 						  cpu_to_be16(proto));
 	}

 	if (gen_resp)
 		status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

 	return status;
 }

 static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
 			       struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 			       bool gen_resp)
 {
 	struct hclge_dev *hdev = vport->back;
 	int ret;

 	ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &hdev->hw_tc_map,
 				   sizeof(u8));

 	return ret;
 }

 static int hclge_get_vf_queue_info(struct hclge_vport *vport,
 				   struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 				   bool gen_resp)
 {
 #define HCLGE_TQPS_RSS_INFO_LEN		8
 	u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
 	struct hclge_dev *hdev = vport->back;

 	/* get the queue related info */
 	memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
 	memcpy(&resp_data[2], &hdev->rss_size_max, sizeof(u16));
 	memcpy(&resp_data[4], &hdev->num_desc, sizeof(u16));
 	memcpy(&resp_data[6], &hdev->rx_buf_len, sizeof(u16));

 	return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 				    HCLGE_TQPS_RSS_INFO_LEN);
 }

 static int hclge_get_link_info(struct hclge_vport *vport,
 			       struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 {
 	struct hclge_dev *hdev = vport->back;
 	u16 link_status;
 	u8 msg_data[2];
 	u8 dest_vfid;

 	/* mac.link can only be 0 or 1 */
 	link_status = (u16)hdev->hw.mac.link;
 	memcpy(&msg_data[0], &link_status, sizeof(u16));
 	dest_vfid = mbx_req->mbx_src_vfid;

 	/* send this requested info to VF */
 	return hclge_send_mbx_msg(vport, msg_data, sizeof(u8),
 				  HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
 }

 static void hclge_reset_vf_queue(struct hclge_vport *vport,
 				 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 {
 	u16 queue_id;

 	memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));

 	hclge_reset_tqp(&vport->nic, queue_id);
 }

 void hclge_mbx_handler(struct hclge_dev *hdev)
 {
 	struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
 	struct hclge_mbx_vf_to_pf_cmd *req;
 	struct hclge_vport *vport;
 	struct hclge_desc *desc;
 	int ret;

 	/* handle all the mailbox requests in the queue */
 	while (hnae_get_bit(crq->desc[crq->next_to_use].flag,
 			    HCLGE_CMDQ_RX_OUTVLD_B)) {
 		desc = &crq->desc[crq->next_to_use];
 		req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;

 		vport = &hdev->vport[req->mbx_src_vfid];

 		switch (req->msg[0]) {
 		case HCLGE_MBX_MAP_RING_TO_VECTOR:
 			ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
 								req);
 			break;
 		case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
 			ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
 								req);
 			break;
 		case HCLGE_MBX_SET_PROMISC_MODE:
 			ret = hclge_set_vf_promisc_mode(vport, req);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF fail(%d) to set VF promisc mode\n",
 					ret);
 			break;
 		case HCLGE_MBX_SET_UNICAST:
 			ret = hclge_set_vf_uc_mac_addr(vport, req, false);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF fail(%d) to set VF UC MAC Addr\n",
 					ret);
 			break;
 		case HCLGE_MBX_SET_MULTICAST:
 			ret = hclge_set_vf_mc_mac_addr(vport, req, false);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF fail(%d) to set VF MC MAC Addr\n",
 					ret);
 			break;
 		case HCLGE_MBX_SET_VLAN:
 			ret = hclge_set_vf_vlan_cfg(vport, req, false);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF failed(%d) to config VF's VLAN\n",
 					ret);
 			break;
 		case HCLGE_MBX_GET_QINFO:
 			ret = hclge_get_vf_queue_info(vport, req, true);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF failed(%d) to get Q info for VF\n",
 					ret);
 			break;
 		case HCLGE_MBX_GET_TCINFO:
 			ret = hclge_get_vf_tcinfo(vport, req, true);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF failed(%d) to get TC info for VF\n",
 					ret);
 			break;
 		case HCLGE_MBX_GET_LINK_STATUS:
 			ret = hclge_get_link_info(vport, req);
 			if (ret)
 				dev_err(&hdev->pdev->dev,
 					"PF fail(%d) to get link stat for VF\n",
 					ret);
 			break;
 		case HCLGE_MBX_QUEUE_RESET:
 			hclge_reset_vf_queue(vport, req);
 			break;
 		default:
 			dev_err(&hdev->pdev->dev,
 				"un-supported mailbox message, code = %d\n",
 				req->msg[0]);
 			break;
 		}
 		hclge_mbx_ring_ptr_move_crq(crq);
 	}

 	/* Write back CMDQ_RQ header pointer, M7 need this pointer */
 	hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
 }
	// SPDX-License-Identifier: GPL-2.0+
	// Copyright (c) 2016-2017 Hisilicon Limited.

	#include "hclge_main.h"
	#include "hclge_mbx.h"
	#include "hnae3.h"

	/* hclge_gen_resp_to_vf: used to generate a synchronous response to VF when PF
	* receives a mailbox message from VF.
	* @vport: pointer to struct hclge_vport
	* @vf_to_pf_req: pointer to hclge_mbx_vf_to_pf_cmd of the original mailbox
	* message
	* @resp_status: indicate to VF whether its request success(0) or failed.
	*/
	static int hclge_gen_resp_to_vf(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req,
	int resp_status,
	u8 *resp_data, u16 resp_data_len)
	{
	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
	struct hclge_dev *hdev = vport->back;
	enum hclge_cmd_status status;
	struct hclge_desc desc;

	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;

	if (resp_data_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) {
	dev_err(&hdev->pdev->dev,
	"PF fail to gen resp to VF len %d exceeds max len %d\n",
	resp_data_len,
	HCLGE_MBX_MAX_RESP_DATA_SIZE);
	}

	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);

	resp_pf_to_vf->dest_vfid = vf_to_pf_req->mbx_src_vfid;
	resp_pf_to_vf->msg_len = vf_to_pf_req->msg_len;

	resp_pf_to_vf->msg[0] = HCLGE_MBX_PF_VF_RESP;
	resp_pf_to_vf->msg[1] = vf_to_pf_req->msg[0];
	resp_pf_to_vf->msg[2] = vf_to_pf_req->msg[1];
	resp_pf_to_vf->msg[3] = (resp_status == 0) ? 0 : 1;

	if (resp_data && resp_data_len > 0)
	memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len);

	status = hclge_cmd_send(&hdev->hw, &desc, 1);
	if (status)
	dev_err(&hdev->pdev->dev,
	"PF failed(=%d) to send response to VF\n", status);

	return status;
	}

	static int hclge_send_mbx_msg(struct hclge_vport vport, u8 msg, u16 msg_len,
	u16 mbx_opcode, u8 dest_vfid)
	{
	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
	struct hclge_dev *hdev = vport->back;
	enum hclge_cmd_status status;
	struct hclge_desc desc;

	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;

	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);

	resp_pf_to_vf->dest_vfid = dest_vfid;
	resp_pf_to_vf->msg_len = msg_len;
	resp_pf_to_vf->msg[0] = mbx_opcode;

	memcpy(&resp_pf_to_vf->msg[1], msg, msg_len);

	status = hclge_cmd_send(&hdev->hw, &desc, 1);
	if (status)
	dev_err(&hdev->pdev->dev,
	"PF failed(=%d) to send mailbox message to VF\n",
	status);

	return status;
	}

	static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
	{
	struct hnae3_ring_chain_node chain_tmp, chain;

	chain = head->next;

	while (chain) {
	chain_tmp = chain->next;
	kzfree(chain);
	chain = chain_tmp;
	}
	}

	/* hclge_get_ring_chain_from_mbx: get ring type & tqpid from mailbox message
	* msg[0]: opcode
	* msg[1]: <not relevant to this function>
	* msg[2]: ring_num
	* msg[3]: first ring type (TX\|RX)
	* msg[4]: first tqp id
	* msg[5] ~ msg[14]: other ring type and tqp id
	*/
	static int hclge_get_ring_chain_from_mbx(
	struct hclge_mbx_vf_to_pf_cmd *req,
	struct hnae3_ring_chain_node *ring_chain,
	struct hclge_vport *vport)
	{
	#define HCLGE_RING_NODE_VARIABLE_NUM 3
	#define HCLGE_RING_MAP_MBX_BASIC_MSG_NUM 3
	struct hnae3_ring_chain_node cur_chain, new_chain;
	int ring_num;
	int i;

	ring_num = req->msg[2];

	hnae_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
	ring_chain->tqp_index =
	hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);

	cur_chain = ring_chain;

	for (i = 1; i < ring_num; i++) {
	new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
	if (!new_chain)
	goto err;

	hnae_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
	req->msg[HCLGE_RING_NODE_VARIABLE_NUM * i +
	HCLGE_RING_MAP_MBX_BASIC_MSG_NUM]);

	new_chain->tqp_index =
	hclge_get_queue_id(vport->nic.kinfo.tqp
	[req->msg[HCLGE_RING_NODE_VARIABLE_NUM * i +
	HCLGE_RING_MAP_MBX_BASIC_MSG_NUM + 1]]);

	cur_chain->next = new_chain;
	cur_chain = new_chain;
	}

	return 0;
	err:
	hclge_free_vector_ring_chain(ring_chain);
	return -ENOMEM;
	}

	static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
	struct hclge_mbx_vf_to_pf_cmd *req)
	{
	struct hnae3_ring_chain_node ring_chain;
	int vector_id = req->msg[1];
	int ret;

	memset(&ring_chain, 0, sizeof(ring_chain));
	ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
	if (ret)
	return ret;

	ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
	if (ret)
	return ret;

	hclge_free_vector_ring_chain(&ring_chain);

	return 0;
	}

	static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *req)
	{
	bool en = req->msg[1] ? true : false;
	struct hclge_promisc_param param;

	/* always enable broadcast promisc bit */
	hclge_promisc_param_init(&param, en, en, true, vport->vport_id);
	return hclge_cmd_set_promisc_mode(vport->back, &param);
	}

	static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	bool gen_resp)
	{
	const u8 mac_addr = (const u8 )(&mbx_req->msg[2]);
	struct hclge_dev *hdev = vport->back;
	int status;

	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
	const u8 old_addr = (const u8 )(&mbx_req->msg[8]);

	hclge_rm_uc_addr_common(vport, old_addr);
	status = hclge_add_uc_addr_common(vport, mac_addr);
	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
	status = hclge_add_uc_addr_common(vport, mac_addr);
	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
	status = hclge_rm_uc_addr_common(vport, mac_addr);
	} else {
	dev_err(&hdev->pdev->dev,
	"failed to set unicast mac addr, unknown subcode %d\n",
	mbx_req->msg[1]);
	return -EIO;
	}

	if (gen_resp)
	hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

	return 0;
	}

	static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	bool gen_resp)
	{
	const u8 mac_addr = (const u8 )(&mbx_req->msg[2]);
	struct hclge_dev *hdev = vport->back;
	int status;

	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
	status = hclge_add_mc_addr_common(vport, mac_addr);
	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
	status = hclge_rm_mc_addr_common(vport, mac_addr);
	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_FUNC_MTA_ENABLE) {
	u8 func_id = vport->vport_id;
	bool enable = mbx_req->msg[2];

	status = hclge_cfg_func_mta_filter(hdev, func_id, enable);
	} else {
	dev_err(&hdev->pdev->dev,
	"failed to set mcast mac addr, unknown subcode %d\n",
	mbx_req->msg[1]);
	return -EIO;
	}

	if (gen_resp)
	hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

	return 0;
	}

	static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	bool gen_resp)
	{
	struct hclge_dev *hdev = vport->back;
	int status = 0;

	if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) {
	u16 vlan, proto;
	bool is_kill;

	is_kill = !!mbx_req->msg[2];
	memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan));
	memcpy(&proto, &mbx_req->msg[5], sizeof(proto));
	status = hclge_set_vf_vlan_common(hdev, vport->vport_id,
	is_kill, vlan, 0,
	cpu_to_be16(proto));
	}

	if (gen_resp)
	status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);

	return status;
	}

	static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	bool gen_resp)
	{
	struct hclge_dev *hdev = vport->back;
	int ret;

	ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &hdev->hw_tc_map,
	sizeof(u8));

	return ret;
	}

	static int hclge_get_vf_queue_info(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	bool gen_resp)
	{
	#define HCLGE_TQPS_RSS_INFO_LEN 8
	u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
	struct hclge_dev *hdev = vport->back;

	/* get the queue related info */
	memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
	memcpy(&resp_data[2], &hdev->rss_size_max, sizeof(u16));
	memcpy(&resp_data[4], &hdev->num_desc, sizeof(u16));
	memcpy(&resp_data[6], &hdev->rx_buf_len, sizeof(u16));

	return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
	HCLGE_TQPS_RSS_INFO_LEN);
	}

	static int hclge_get_link_info(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req)
	{
	struct hclge_dev *hdev = vport->back;
	u16 link_status;
	u8 msg_data[2];
	u8 dest_vfid;

	/* mac.link can only be 0 or 1 */
	link_status = (u16)hdev->hw.mac.link;
	memcpy(&msg_data[0], &link_status, sizeof(u16));
	dest_vfid = mbx_req->mbx_src_vfid;

	/* send this requested info to VF */
	return hclge_send_mbx_msg(vport, msg_data, sizeof(u8),
	HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
	}

	static void hclge_reset_vf_queue(struct hclge_vport *vport,
	struct hclge_mbx_vf_to_pf_cmd *mbx_req)
	{
	u16 queue_id;

	memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));

	hclge_reset_tqp(&vport->nic, queue_id);
	}

	void hclge_mbx_handler(struct hclge_dev *hdev)
	{
	struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
	struct hclge_mbx_vf_to_pf_cmd *req;
	struct hclge_vport *vport;
	struct hclge_desc *desc;
	int ret;

	/* handle all the mailbox requests in the queue */
	while (hnae_get_bit(crq->desc[crq->next_to_use].flag,
	HCLGE_CMDQ_RX_OUTVLD_B)) {
	desc = &crq->desc[crq->next_to_use];
	req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;

	vport = &hdev->vport[req->mbx_src_vfid];

	switch (req->msg[0]) {
	case HCLGE_MBX_MAP_RING_TO_VECTOR:
	ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
	req);
	break;
	case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
	ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
	req);
	break;
	case HCLGE_MBX_SET_PROMISC_MODE:
	ret = hclge_set_vf_promisc_mode(vport, req);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF fail(%d) to set VF promisc mode\n",
	ret);
	break;
	case HCLGE_MBX_SET_UNICAST:
	ret = hclge_set_vf_uc_mac_addr(vport, req, false);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF fail(%d) to set VF UC MAC Addr\n",
	ret);
	break;
	case HCLGE_MBX_SET_MULTICAST:
	ret = hclge_set_vf_mc_mac_addr(vport, req, false);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF fail(%d) to set VF MC MAC Addr\n",
	ret);
	break;
	case HCLGE_MBX_SET_VLAN:
	ret = hclge_set_vf_vlan_cfg(vport, req, false);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF failed(%d) to config VF's VLAN\n",
	ret);
	break;
	case HCLGE_MBX_GET_QINFO:
	ret = hclge_get_vf_queue_info(vport, req, true);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF failed(%d) to get Q info for VF\n",
	ret);
	break;
	case HCLGE_MBX_GET_TCINFO:
	ret = hclge_get_vf_tcinfo(vport, req, true);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF failed(%d) to get TC info for VF\n",
	ret);
	break;
	case HCLGE_MBX_GET_LINK_STATUS:
	ret = hclge_get_link_info(vport, req);
	if (ret)
	dev_err(&hdev->pdev->dev,
	"PF fail(%d) to get link stat for VF\n",
	ret);
	break;
	case HCLGE_MBX_QUEUE_RESET:
	hclge_reset_vf_queue(vport, req);
	break;
	default:
	dev_err(&hdev->pdev->dev,
	"un-supported mailbox message, code = %d\n",
	req->msg[0]);
	break;
	}
	hclge_mbx_ring_ptr_move_crq(crq);
	}

	/* Write back CMDQ_RQ header pointer, M7 need this pointer */
	hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
	}