1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright (c) 2016-2017 Hisilicon Limited.
5 #include "hclgevf_main.h"
8 static void hclgevf_reset_mbx_resp_status(struct hclgevf_dev *hdev)
10 /* this function should be called with mbx_resp.mbx_mutex held
11 * to prtect the received_response from race condition
13 hdev->mbx_resp.received_resp = false;
14 hdev->mbx_resp.origin_mbx_msg = 0;
15 hdev->mbx_resp.resp_status = 0;
16 memset(hdev->mbx_resp.additional_info, 0, HCLGE_MBX_MAX_RESP_DATA_SIZE);
19 /* hclgevf_get_mbx_resp: used to get a response from PF after VF sends a mailbox
21 * @hdev: pointer to struct hclgevf_dev
22 * @resp_msg: pointer to store the original message type and response status
23 * @len: the resp_msg data array length.
25 static int hclgevf_get_mbx_resp(struct hclgevf_dev *hdev, u16 code0, u16 code1,
26 u8 *resp_data, u16 resp_len)
28 #define HCLGEVF_MAX_TRY_TIMES 500
29 #define HCLGEVF_SLEEP_USCOEND 1000
30 struct hclgevf_mbx_resp_status *mbx_resp;
34 if (resp_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) {
35 dev_err(&hdev->pdev->dev,
36 "VF mbx response len(=%d) exceeds maximum(=%d)\n",
38 HCLGE_MBX_MAX_RESP_DATA_SIZE);
42 while ((!hdev->mbx_resp.received_resp) && (i < HCLGEVF_MAX_TRY_TIMES)) {
43 udelay(HCLGEVF_SLEEP_USCOEND);
47 if (i >= HCLGEVF_MAX_TRY_TIMES) {
48 dev_err(&hdev->pdev->dev,
49 "VF could not get mbx resp(=%d) from PF in %d tries\n",
50 hdev->mbx_resp.received_resp, i);
54 mbx_resp = &hdev->mbx_resp;
55 r_code0 = (u16)(mbx_resp->origin_mbx_msg >> 16);
56 r_code1 = (u16)(mbx_resp->origin_mbx_msg & 0xff);
58 if (mbx_resp->resp_status)
59 return mbx_resp->resp_status;
62 memcpy(resp_data, &mbx_resp->additional_info[0], resp_len);
64 hclgevf_reset_mbx_resp_status(hdev);
66 if (!(r_code0 == code0 && r_code1 == code1 && !mbx_resp->resp_status)) {
67 dev_err(&hdev->pdev->dev,
68 "VF could not match resp code(code0=%d,code1=%d), %d",
69 code0, code1, mbx_resp->resp_status);
76 int hclgevf_send_mbx_msg(struct hclgevf_dev *hdev, u16 code, u16 subcode,
77 const u8 *msg_data, u8 msg_len, bool need_resp,
78 u8 *resp_data, u16 resp_len)
80 struct hclge_mbx_vf_to_pf_cmd *req;
81 struct hclgevf_desc desc;
84 req = (struct hclge_mbx_vf_to_pf_cmd *)desc.data;
86 /* first two bytes are reserved for code & subcode */
87 if (msg_len > (HCLGE_MBX_MAX_MSG_SIZE - 2)) {
88 dev_err(&hdev->pdev->dev,
89 "VF send mbx msg fail, msg len %d exceeds max len %d\n",
90 msg_len, HCLGE_MBX_MAX_MSG_SIZE);
94 hclgevf_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_VF_TO_PF, false);
96 req->msg[1] = subcode;
97 memcpy(&req->msg[2], msg_data, msg_len);
99 /* synchronous send */
101 mutex_lock(&hdev->mbx_resp.mbx_mutex);
102 hclgevf_reset_mbx_resp_status(hdev);
103 status = hclgevf_cmd_send(&hdev->hw, &desc, 1);
105 dev_err(&hdev->pdev->dev,
106 "VF failed(=%d) to send mbx message to PF\n",
108 mutex_unlock(&hdev->mbx_resp.mbx_mutex);
112 status = hclgevf_get_mbx_resp(hdev, code, subcode, resp_data,
114 mutex_unlock(&hdev->mbx_resp.mbx_mutex);
116 /* asynchronous send */
117 status = hclgevf_cmd_send(&hdev->hw, &desc, 1);
119 dev_err(&hdev->pdev->dev,
120 "VF failed(=%d) to send mbx message to PF\n",
129 void hclgevf_mbx_handler(struct hclgevf_dev *hdev)
131 struct hclgevf_mbx_resp_status *resp;
132 struct hclge_mbx_pf_to_vf_cmd *req;
133 struct hclgevf_cmq_ring *crq;
134 struct hclgevf_desc *desc;
135 u16 link_status, flag;
141 resp = &hdev->mbx_resp;
142 crq = &hdev->hw.cmq.crq;
144 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
145 while (hnae_get_bit(flag, HCLGEVF_CMDQ_RX_OUTVLD_B)) {
146 desc = &crq->desc[crq->next_to_use];
147 req = (struct hclge_mbx_pf_to_vf_cmd *)desc->data;
149 switch (req->msg[0]) {
150 case HCLGE_MBX_PF_VF_RESP:
151 if (resp->received_resp)
152 dev_warn(&hdev->pdev->dev,
153 "VF mbx resp flag not clear(%d)\n",
155 resp->received_resp = true;
157 resp->origin_mbx_msg = (req->msg[1] << 16);
158 resp->origin_mbx_msg |= req->msg[2];
159 resp->resp_status = req->msg[3];
161 temp = (u8 *)&req->msg[4];
162 for (i = 0; i < HCLGE_MBX_MAX_RESP_DATA_SIZE; i++) {
163 resp->additional_info[i] = *temp;
167 case HCLGE_MBX_LINK_STAT_CHANGE:
168 link_status = le16_to_cpu(req->msg[1]);
169 memcpy(&speed, &req->msg[2], sizeof(speed));
170 duplex = (u8)le16_to_cpu(req->msg[4]);
172 /* update upper layer with new link link status */
173 hclgevf_update_link_status(hdev, link_status);
174 hclgevf_update_speed_duplex(hdev, speed, duplex);
178 dev_err(&hdev->pdev->dev,
179 "VF received unsupported(%d) mbx msg from PF\n",
183 crq->desc[crq->next_to_use].flag = 0;
184 hclge_mbx_ring_ptr_move_crq(crq);
185 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
188 /* Write back CMDQ_RQ header pointer, M7 need this pointer */
189 hclgevf_write_dev(&hdev->hw, HCLGEVF_NIC_CRQ_HEAD_REG,