[linux-2.6-block.git] / drivers / net / ethernet / hisilicon / hns3 / hns3pf / hclge_mbx.c

// 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 int hclge_inform_reset_assert_to_vf(struct hclge_vport *vport)
{
	u8 msg_data[2];
	u8 dest_vfid;

	dest_vfid = (u8)vport->vport_id;

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

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)
{
	struct hnae3_ring_chain_node *cur_chain, *new_chain;
	int ring_num;
	int i;

	ring_num = req->msg[2];

	if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM -
		HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) /
		HCLGE_MBX_RING_NODE_VARIABLE_NUM))
		return -ENOMEM;

	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]]);
	hnae_set_field(ring_chain->int_gl_idx, HCLGE_INT_GL_IDX_M,
		       HCLGE_INT_GL_IDX_S,
		       req->msg[5]);

	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_MBX_RING_NODE_VARIABLE_NUM * i +
			     HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]);

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

		hnae_set_field(new_chain->int_gl_idx, HCLGE_INT_GL_IDX_M,
			       HCLGE_INT_GL_IDX_S,
			       req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
			       HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);

		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);
		if (status)
			hclge_add_uc_addr_common(vport, old_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], &vport->nic.kinfo.rss_size, 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[8];
	u8 dest_vfid;
	u16 duplex;

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

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

static void hclge_mbx_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_vf_queue(vport, queue_id);

	/* send response msg to VF after queue reset complete*/
	hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
}

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

	dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %d!",
		 mbx_req->mbx_src_vfid);

	/* Acknowledge VF that PF is now about to assert the reset for the VF.
	 * On receiving this message VF will get into pending state and will
	 * start polling for the hardware reset completion status.
	 */
	ret = hclge_inform_reset_assert_to_vf(vport);
	if (ret) {
		dev_err(&hdev->pdev->dev,
			"PF fail(%d) to inform VF(%d)of reset, reset failed!\n",
			ret, vport->vport_id);
		return;
	}

	dev_warn(&hdev->pdev->dev, "PF is now resetting VF %d.\n",
		 mbx_req->mbx_src_vfid);
	/* reset this virtual function */
	hclge_func_reset_cmd(hdev, mbx_req->mbx_src_vfid);
}

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, flag;

	flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
	/* handle all the mailbox requests in the queue */
	while (hnae_get_bit(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, true);
			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_mbx_reset_vf_queue(vport, req);
			break;
		case HCLGE_MBX_RESET:
			hclge_reset_vf(vport, req);
			break;
		default:
			dev_err(&hdev->pdev->dev,
				"un-supported mailbox message, code = %d\n",
				req->msg[0]);
			break;
		}
		crq->desc[crq->next_to_use].flag = 0;
		hclge_mbx_ring_ptr_move_crq(crq);
		flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
	}

	/* Write back CMDQ_RQ header pointer, M7 need this pointer */
	hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
}
Commit	Line	Data
dde1a86e SM	1	// SPDX-License-Identifier: GPL-2.0+
	2	// Copyright (c) 2016-2017 Hisilicon Limited.
	3
	4	#include "hclge_main.h"
	5	#include "hclge_mbx.h"
	6	#include "hnae3.h"
	7
	8	/* hclge_gen_resp_to_vf: used to generate a synchronous response to VF when PF
	9	* receives a mailbox message from VF.
	10	* @vport: pointer to struct hclge_vport
	11	* @vf_to_pf_req: pointer to hclge_mbx_vf_to_pf_cmd of the original mailbox
	12	* message
	13	* @resp_status: indicate to VF whether its request success(0) or failed.
	14	*/
	15	static int hclge_gen_resp_to_vf(struct hclge_vport *vport,
	16	struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req,
	17	int resp_status,
	18	u8 *resp_data, u16 resp_data_len)
	19	{
	20	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
	21	struct hclge_dev *hdev = vport->back;
	22	enum hclge_cmd_status status;
	23	struct hclge_desc desc;
	24
	25	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
	26
	27	if (resp_data_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) {
	28	dev_err(&hdev->pdev->dev,
	29	"PF fail to gen resp to VF len %d exceeds max len %d\n",
	30	resp_data_len,
	31	HCLGE_MBX_MAX_RESP_DATA_SIZE);
	32	}
	33
	34	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
	35
	36	resp_pf_to_vf->dest_vfid = vf_to_pf_req->mbx_src_vfid;
	37	resp_pf_to_vf->msg_len = vf_to_pf_req->msg_len;
	38
	39	resp_pf_to_vf->msg[0] = HCLGE_MBX_PF_VF_RESP;
	40	resp_pf_to_vf->msg[1] = vf_to_pf_req->msg[0];
	41	resp_pf_to_vf->msg[2] = vf_to_pf_req->msg[1];
	42	resp_pf_to_vf->msg[3] = (resp_status == 0) ? 0 : 1;
	43
	44	if (resp_data && resp_data_len > 0)
	45	memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len);
	46
	47	status = hclge_cmd_send(&hdev->hw, &desc, 1);
	48	if (status)
	49	dev_err(&hdev->pdev->dev,
	50	"PF failed(=%d) to send response to VF\n", status);
	51
	52	return status;
	53	}
	54
	55	static int hclge_send_mbx_msg(struct hclge_vport vport, u8 msg, u16 msg_len,
	56	u16 mbx_opcode, u8 dest_vfid)
	57	{
	58	struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
	59	struct hclge_dev *hdev = vport->back;
	60	enum hclge_cmd_status status;
	61	struct hclge_desc desc;
	62
	63	resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
	64
65	hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
66
67	resp_pf_to_vf->dest_vfid = dest_vfid;
68	resp_pf_to_vf->msg_len = msg_len;
69	resp_pf_to_vf->msg[0] = mbx_opcode;
70
71	memcpy(&resp_pf_to_vf->msg[1], msg, msg_len);
72
73	status = hclge_cmd_send(&hdev->hw, &desc, 1);
74	if (status)
75	dev_err(&hdev->pdev->dev,
76	"PF failed(=%d) to send mailbox message to VF\n",
77	status);
78
79	return status;
80	}
81
d5eabf0c	82	static int hclge_inform_reset_assert_to_vf(struct hclge_vport *vport)
2bfbd35d SM	83	{
	84	u8 msg_data[2];
	85	u8 dest_vfid;
	86
	87	dest_vfid = (u8)vport->vport_id;
	88
	89	/* send this requested info to VF */
	90	return hclge_send_mbx_msg(vport, msg_data, sizeof(u8),
	91	HCLGE_MBX_ASSERTING_RESET, dest_vfid);
	92	}
	93
84e095d6 SM	94	static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
	95	{
	96	struct hnae3_ring_chain_node chain_tmp, chain;
	97
	98	chain = head->next;
	99
	100	while (chain) {
	101	chain_tmp = chain->next;
	102	kzfree(chain);
	103	chain = chain_tmp;
	104	}
	105	}
	106
	107	/* hclge_get_ring_chain_from_mbx: get ring type & tqpid from mailbox message
	108	* msg[0]: opcode
	109	* msg[1]: <not relevant to this function>
	110	* msg[2]: ring_num
	111	* msg[3]: first ring type (TX\|RX)
	112	* msg[4]: first tqp id
	113	* msg[5] ~ msg[14]: other ring type and tqp id
	114	*/
	115	static int hclge_get_ring_chain_from_mbx(
	116	struct hclge_mbx_vf_to_pf_cmd *req,
	117	struct hnae3_ring_chain_node *ring_chain,
	118	struct hclge_vport *vport)
	119	{
84e095d6 SM	120	struct hnae3_ring_chain_node cur_chain, new_chain;
	121	int ring_num;
	122	int i;
	123
	124	ring_num = req->msg[2];
	125
5d02a58d YL	126	if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM -
	127	HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) /
	128	HCLGE_MBX_RING_NODE_VARIABLE_NUM))
	129	return -ENOMEM;
	130
84e095d6 SM	131	hnae_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
	132	ring_chain->tqp_index =
	133	hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);
79eee410 FL	134	hnae_set_field(ring_chain->int_gl_idx, HCLGE_INT_GL_IDX_M,
	135	HCLGE_INT_GL_IDX_S,
	136	req->msg[5]);
84e095d6 SM	137
	138	cur_chain = ring_chain;
	139
	140	for (i = 1; i < ring_num; i++) {
	141	new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
	142	if (!new_chain)
	143	goto err;
	144
	145	hnae_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
5d02a58d YL	146	req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
5d02a58d YL	147	HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]);
84e095d6 SM	148
	149	new_chain->tqp_index =
	150	hclge_get_queue_id(vport->nic.kinfo.tqp
5d02a58d YL	151	[req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
5d02a58d YL	152	HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 1]]);
84e095d6	153
79eee410 FL	154	hnae_set_field(new_chain->int_gl_idx, HCLGE_INT_GL_IDX_M,
79eee410 FL	155	HCLGE_INT_GL_IDX_S,
5d02a58d YL	156	req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
5d02a58d YL	157	HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);
79eee410	158
84e095d6 SM	159	cur_chain->next = new_chain;
	160	cur_chain = new_chain;
	161	}
	162
	163	return 0;
	164	err:
	165	hclge_free_vector_ring_chain(ring_chain);
	166	return -ENOMEM;
	167	}
	168
	169	static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
	170	struct hclge_mbx_vf_to_pf_cmd *req)
	171	{
	172	struct hnae3_ring_chain_node ring_chain;
	173	int vector_id = req->msg[1];
	174	int ret;
	175
	176	memset(&ring_chain, 0, sizeof(ring_chain));
	177	ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
	178	if (ret)
	179	return ret;
	180
	181	ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
	182	if (ret)
	183	return ret;
	184
	185	hclge_free_vector_ring_chain(&ring_chain);
	186
	187	return 0;
	188	}
	189
dde1a86e SM	190	static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
	191	struct hclge_mbx_vf_to_pf_cmd *req)
	192	{
	193	bool en = req->msg[1] ? true : false;
	194	struct hclge_promisc_param param;
	195
	196	/* always enable broadcast promisc bit */
	197	hclge_promisc_param_init(&param, en, en, true, vport->vport_id);
	198	return hclge_cmd_set_promisc_mode(vport->back, &param);
	199	}
	200
	201	static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
	202	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	203	bool gen_resp)
	204	{
	205	const u8 mac_addr = (const u8 )(&mbx_req->msg[2]);
	206	struct hclge_dev *hdev = vport->back;
	207	int status;
	208
	209	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
	210	const u8 old_addr = (const u8 )(&mbx_req->msg[8]);
	211
	212	hclge_rm_uc_addr_common(vport, old_addr);
	213	status = hclge_add_uc_addr_common(vport, mac_addr);
59098055 FL	214	if (status)
59098055 FL	215	hclge_add_uc_addr_common(vport, old_addr);
dde1a86e SM	216	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
	217	status = hclge_add_uc_addr_common(vport, mac_addr);
	218	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
	219	status = hclge_rm_uc_addr_common(vport, mac_addr);
	220	} else {
	221	dev_err(&hdev->pdev->dev,
	222	"failed to set unicast mac addr, unknown subcode %d\n",
	223	mbx_req->msg[1]);
	224	return -EIO;
	225	}
	226
	227	if (gen_resp)
	228	hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
	229
	230	return 0;
	231	}
	232
	233	static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
	234	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	235	bool gen_resp)
	236	{
	237	const u8 mac_addr = (const u8 )(&mbx_req->msg[2]);
	238	struct hclge_dev *hdev = vport->back;
	239	int status;
	240
	241	if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
	242	status = hclge_add_mc_addr_common(vport, mac_addr);
	243	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
	244	status = hclge_rm_mc_addr_common(vport, mac_addr);
	245	} else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_FUNC_MTA_ENABLE) {
	246	u8 func_id = vport->vport_id;
	247	bool enable = mbx_req->msg[2];
	248
	249	status = hclge_cfg_func_mta_filter(hdev, func_id, enable);
	250	} else {
	251	dev_err(&hdev->pdev->dev,
	252	"failed to set mcast mac addr, unknown subcode %d\n",
	253	mbx_req->msg[1]);
	254	return -EIO;
	255	}
	256
	257	if (gen_resp)
	258	hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
	259
	260	return 0;
	261	}
	262
	263	static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
	264	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
	265	bool gen_resp)
	266	{
	267	struct hclge_dev *hdev = vport->back;
	268	int status = 0;
	269
	270	if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) {
	271	u16 vlan, proto;
	272	bool is_kill;
	273
	274	is_kill = !!mbx_req->msg[2];
	275	memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan));
	276	memcpy(&proto, &mbx_req->msg[5], sizeof(proto));
	277	status = hclge_set_vf_vlan_common(hdev, vport->vport_id,
	278	is_kill, vlan, 0,
	279	cpu_to_be16(proto));
280	}
281
282	if (gen_resp)
283	status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
284
285	return status;
286	}
287
288	static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
289	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
290	bool gen_resp)
291	{
292	struct hclge_dev *hdev = vport->back;
293	int ret;
294
295	ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &hdev->hw_tc_map,
296	sizeof(u8));
297
298	return ret;
299	}
300
301	static int hclge_get_vf_queue_info(struct hclge_vport *vport,
302	struct hclge_mbx_vf_to_pf_cmd *mbx_req,
303	bool gen_resp)
304	{
305	#define HCLGE_TQPS_RSS_INFO_LEN 8
306	u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
307	struct hclge_dev *hdev = vport->back;
308
309	/* get the queue related info */
310	memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
f5e084b8	311	memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16));
dde1a86e SM	312	memcpy(&resp_data[4], &hdev->num_desc, sizeof(u16));
	313	memcpy(&resp_data[6], &hdev->rx_buf_len, sizeof(u16));
	314
	315	return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
	316	HCLGE_TQPS_RSS_INFO_LEN);
	317	}
	318
	319	static int hclge_get_link_info(struct hclge_vport *vport,
	320	struct hclge_mbx_vf_to_pf_cmd *mbx_req)
	321	{
	322	struct hclge_dev *hdev = vport->back;
	323	u16 link_status;
4a152de9	324	u8 msg_data[8];
dde1a86e	325	u8 dest_vfid;
4a152de9	326	u16 duplex;
dde1a86e SM	327
	328	/* mac.link can only be 0 or 1 */
	329	link_status = (u16)hdev->hw.mac.link;
4a152de9	330	duplex = hdev->hw.mac.duplex;
dde1a86e	331	memcpy(&msg_data[0], &link_status, sizeof(u16));
4a152de9 FL	332	memcpy(&msg_data[2], &hdev->hw.mac.speed, sizeof(u32));
4a152de9 FL	333	memcpy(&msg_data[6], &duplex, sizeof(u16));
dde1a86e SM	334	dest_vfid = mbx_req->mbx_src_vfid;
	335
	336	/* send this requested info to VF */
4a152de9	337	return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
dde1a86e SM	338	HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
	339	}
	340
1a426f8b PL	341	static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport,
1a426f8b PL	342	struct hclge_mbx_vf_to_pf_cmd *mbx_req)
84e095d6 SM	343	{
	344	u16 queue_id;
	345
	346	memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
	347
1a426f8b PL	348	hclge_reset_vf_queue(vport, queue_id);
	349
	350	/* send response msg to VF after queue reset complete*/
	351	hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
84e095d6 SM	352	}
84e095d6 SM	353
2bfbd35d SM	354	static void hclge_reset_vf(struct hclge_vport *vport,
	355	struct hclge_mbx_vf_to_pf_cmd *mbx_req)
	356	{
	357	struct hclge_dev *hdev = vport->back;
	358	int ret;
	359
	360	dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %d!",
	361	mbx_req->mbx_src_vfid);
	362
	363	/* Acknowledge VF that PF is now about to assert the reset for the VF.
	364	* On receiving this message VF will get into pending state and will
	365	* start polling for the hardware reset completion status.
	366	*/
	367	ret = hclge_inform_reset_assert_to_vf(vport);
	368	if (ret) {
	369	dev_err(&hdev->pdev->dev,
	370	"PF fail(%d) to inform VF(%d)of reset, reset failed!\n",
	371	ret, vport->vport_id);
	372	return;
	373	}
	374
	375	dev_warn(&hdev->pdev->dev, "PF is now resetting VF %d.\n",
	376	mbx_req->mbx_src_vfid);
	377	/* reset this virtual function */
	378	hclge_func_reset_cmd(hdev, mbx_req->mbx_src_vfid);
	379	}
	380
dde1a86e SM	381	void hclge_mbx_handler(struct hclge_dev *hdev)
	382	{
	383	struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
	384	struct hclge_mbx_vf_to_pf_cmd *req;
	385	struct hclge_vport *vport;
	386	struct hclge_desc *desc;
f18f0d4d	387	int ret, flag;
dde1a86e	388
f18f0d4d	389	flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
dde1a86e	390	/* handle all the mailbox requests in the queue */
f18f0d4d	391	while (hnae_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B)) {
dde1a86e SM	392	desc = &crq->desc[crq->next_to_use];
	393	req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;
	394
	395	vport = &hdev->vport[req->mbx_src_vfid];
	396
	397	switch (req->msg[0]) {
84e095d6 SM	398	case HCLGE_MBX_MAP_RING_TO_VECTOR:
	399	ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
	400	req);
	401	break;
	402	case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
	403	ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
	404	req);
	405	break;
dde1a86e SM	406	case HCLGE_MBX_SET_PROMISC_MODE:
	407	ret = hclge_set_vf_promisc_mode(vport, req);
	408	if (ret)
	409	dev_err(&hdev->pdev->dev,
	410	"PF fail(%d) to set VF promisc mode\n",
	411	ret);
	412	break;
	413	case HCLGE_MBX_SET_UNICAST:
2097fdef	414	ret = hclge_set_vf_uc_mac_addr(vport, req, true);
dde1a86e SM	415	if (ret)
	416	dev_err(&hdev->pdev->dev,
	417	"PF fail(%d) to set VF UC MAC Addr\n",
	418	ret);
	419	break;
	420	case HCLGE_MBX_SET_MULTICAST:
	421	ret = hclge_set_vf_mc_mac_addr(vport, req, false);
	422	if (ret)
	423	dev_err(&hdev->pdev->dev,
	424	"PF fail(%d) to set VF MC MAC Addr\n",
	425	ret);
	426	break;
	427	case HCLGE_MBX_SET_VLAN:
	428	ret = hclge_set_vf_vlan_cfg(vport, req, false);
	429	if (ret)
	430	dev_err(&hdev->pdev->dev,
	431	"PF failed(%d) to config VF's VLAN\n",
	432	ret);
	433	break;
	434	case HCLGE_MBX_GET_QINFO:
	435	ret = hclge_get_vf_queue_info(vport, req, true);
	436	if (ret)
	437	dev_err(&hdev->pdev->dev,
	438	"PF failed(%d) to get Q info for VF\n",
	439	ret);
	440	break;
	441	case HCLGE_MBX_GET_TCINFO:
	442	ret = hclge_get_vf_tcinfo(vport, req, true);
	443	if (ret)
	444	dev_err(&hdev->pdev->dev,
	445	"PF failed(%d) to get TC info for VF\n",
	446	ret);
	447	break;
	448	case HCLGE_MBX_GET_LINK_STATUS:
	449	ret = hclge_get_link_info(vport, req);
	450	if (ret)
	451	dev_err(&hdev->pdev->dev,
	452	"PF fail(%d) to get link stat for VF\n",
	453	ret);
	454	break;
84e095d6	455	case HCLGE_MBX_QUEUE_RESET:
1a426f8b	456	hclge_mbx_reset_vf_queue(vport, req);
84e095d6	457	break;
2bfbd35d SM	458	case HCLGE_MBX_RESET:
	459	hclge_reset_vf(vport, req);
	460	break;
dde1a86e SM	461	default:
	462	dev_err(&hdev->pdev->dev,
	463	"un-supported mailbox message, code = %d\n",
	464	req->msg[0]);
	465	break;
	466	}
090e3b53	467	crq->desc[crq->next_to_use].flag = 0;
dde1a86e	468	hclge_mbx_ring_ptr_move_crq(crq);
f18f0d4d	469	flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
dde1a86e SM	470	}
	471
	472	/* Write back CMDQ_RQ header pointer, M7 need this pointer */
	473	hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
	474	}