1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright (c) 2016-2017 Hisilicon Limited.
4 #include "hclge_main.h"
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
13 * @resp_status: indicate to VF whether its request success(0) or failed.
15 static int hclge_gen_resp_to_vf(struct hclge_vport *vport,
16 struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req,
18 u8 *resp_data, u16 resp_data_len)
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;
25 resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
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",
31 HCLGE_MBX_MAX_RESP_DATA_SIZE);
34 hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
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;
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;
44 if (resp_data && resp_data_len > 0)
45 memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len);
47 status = hclge_cmd_send(&hdev->hw, &desc, 1);
49 dev_err(&hdev->pdev->dev,
50 "PF failed(=%d) to send response to VF\n", status);
55 static int hclge_send_mbx_msg(struct hclge_vport *vport, u8 *msg, u16 msg_len,
56 u16 mbx_opcode, u8 dest_vfid)
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;
63 resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
65 hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
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;
71 memcpy(&resp_pf_to_vf->msg[1], msg, msg_len);
73 status = hclge_cmd_send(&hdev->hw, &desc, 1);
75 dev_err(&hdev->pdev->dev,
76 "PF failed(=%d) to send mailbox message to VF\n",
82 int hclge_inform_reset_assert_to_vf(struct hclge_vport *vport)
84 struct hclge_dev *hdev = vport->back;
85 enum hnae3_reset_type reset_type;
89 dest_vfid = (u8)vport->vport_id;
91 if (hdev->reset_type == HNAE3_FUNC_RESET)
92 reset_type = HNAE3_VF_PF_FUNC_RESET;
93 else if (hdev->reset_type == HNAE3_FLR_RESET)
94 reset_type = HNAE3_VF_FULL_RESET;
98 memcpy(&msg_data[0], &reset_type, sizeof(u16));
100 /* send this requested info to VF */
101 return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
102 HCLGE_MBX_ASSERTING_RESET, dest_vfid);
105 static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
107 struct hnae3_ring_chain_node *chain_tmp, *chain;
112 chain_tmp = chain->next;
118 /* hclge_get_ring_chain_from_mbx: get ring type & tqp id & int_gl idx
119 * from mailbox message
121 * msg[1]: <not relevant to this function>
123 * msg[3]: first ring type (TX|RX)
124 * msg[4]: first tqp id
125 * msg[5]: first int_gl idx
126 * msg[6] ~ msg[14]: other ring type, tqp id and int_gl idx
128 static int hclge_get_ring_chain_from_mbx(
129 struct hclge_mbx_vf_to_pf_cmd *req,
130 struct hnae3_ring_chain_node *ring_chain,
131 struct hclge_vport *vport)
133 struct hnae3_ring_chain_node *cur_chain, *new_chain;
137 ring_num = req->msg[2];
139 if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM -
140 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) /
141 HCLGE_MBX_RING_NODE_VARIABLE_NUM))
144 hnae3_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
145 ring_chain->tqp_index =
146 hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);
147 hnae3_set_field(ring_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
151 cur_chain = ring_chain;
153 for (i = 1; i < ring_num; i++) {
154 new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
158 hnae3_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
159 req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
160 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]);
162 new_chain->tqp_index =
163 hclge_get_queue_id(vport->nic.kinfo.tqp
164 [req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
165 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 1]]);
167 hnae3_set_field(new_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
169 req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
170 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);
172 cur_chain->next = new_chain;
173 cur_chain = new_chain;
178 hclge_free_vector_ring_chain(ring_chain);
182 static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
183 struct hclge_mbx_vf_to_pf_cmd *req)
185 struct hnae3_ring_chain_node ring_chain;
186 int vector_id = req->msg[1];
189 memset(&ring_chain, 0, sizeof(ring_chain));
190 ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
194 ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
198 hclge_free_vector_ring_chain(&ring_chain);
203 static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
204 struct hclge_mbx_vf_to_pf_cmd *req)
206 bool en_bc = req->msg[1] ? true : false;
207 struct hclge_promisc_param param;
209 /* vf is not allowed to enable unicast/multicast broadcast */
210 hclge_promisc_param_init(¶m, false, false, en_bc, vport->vport_id);
211 return hclge_cmd_set_promisc_mode(vport->back, ¶m);
214 static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
215 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
218 const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
219 struct hclge_dev *hdev = vport->back;
222 if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
223 const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]);
225 hclge_rm_uc_addr_common(vport, old_addr);
226 status = hclge_add_uc_addr_common(vport, mac_addr);
228 hclge_add_uc_addr_common(vport, old_addr);
230 hclge_rm_vport_mac_table(vport, mac_addr,
231 false, HCLGE_MAC_ADDR_UC);
232 hclge_add_vport_mac_table(vport, mac_addr,
235 } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
236 status = hclge_add_uc_addr_common(vport, mac_addr);
238 hclge_add_vport_mac_table(vport, mac_addr,
240 } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
241 status = hclge_rm_uc_addr_common(vport, mac_addr);
243 hclge_rm_vport_mac_table(vport, mac_addr,
244 false, HCLGE_MAC_ADDR_UC);
246 dev_err(&hdev->pdev->dev,
247 "failed to set unicast mac addr, unknown subcode %d\n",
253 hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
258 static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
259 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
262 const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
263 struct hclge_dev *hdev = vport->back;
268 if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
269 status = hclge_add_mc_addr_common(vport, mac_addr);
271 hclge_add_vport_mac_table(vport, mac_addr,
273 } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
274 status = hclge_rm_mc_addr_common(vport, mac_addr);
276 hclge_rm_vport_mac_table(vport, mac_addr,
277 false, HCLGE_MAC_ADDR_MC);
279 dev_err(&hdev->pdev->dev,
280 "failed to set mcast mac addr, unknown subcode %d\n",
286 hclge_gen_resp_to_vf(vport, mbx_req, status,
287 &resp_data, resp_len);
292 static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
293 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
298 if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) {
299 struct hnae3_handle *handle = &vport->nic;
303 is_kill = !!mbx_req->msg[2];
304 memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan));
305 memcpy(&proto, &mbx_req->msg[5], sizeof(proto));
306 status = hclge_set_vlan_filter(handle, cpu_to_be16(proto),
308 } else if (mbx_req->msg[1] == HCLGE_MBX_VLAN_RX_OFF_CFG) {
309 struct hnae3_handle *handle = &vport->nic;
310 bool en = mbx_req->msg[2] ? true : false;
312 status = hclge_en_hw_strip_rxvtag(handle, en);
316 status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
321 static int hclge_set_vf_alive(struct hclge_vport *vport,
322 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
325 bool alive = !!mbx_req->msg[2];
329 ret = hclge_vport_start(vport);
331 hclge_vport_stop(vport);
336 static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
337 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
340 struct hnae3_knic_private_info *kinfo = &vport->nic.kinfo;
344 for (i = 0; i < kinfo->num_tc; i++)
347 ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &vf_tc_map,
353 static int hclge_get_vf_queue_info(struct hclge_vport *vport,
354 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
357 #define HCLGE_TQPS_RSS_INFO_LEN 6
358 u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
359 struct hclge_dev *hdev = vport->back;
361 /* get the queue related info */
362 memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
363 memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16));
364 memcpy(&resp_data[4], &hdev->rx_buf_len, sizeof(u16));
366 return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
367 HCLGE_TQPS_RSS_INFO_LEN);
370 static int hclge_get_vf_queue_depth(struct hclge_vport *vport,
371 struct hclge_mbx_vf_to_pf_cmd *mbx_req,
374 #define HCLGE_TQPS_DEPTH_INFO_LEN 4
375 u8 resp_data[HCLGE_TQPS_DEPTH_INFO_LEN];
376 struct hclge_dev *hdev = vport->back;
378 /* get the queue depth info */
379 memcpy(&resp_data[0], &hdev->num_tx_desc, sizeof(u16));
380 memcpy(&resp_data[2], &hdev->num_rx_desc, sizeof(u16));
381 return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
382 HCLGE_TQPS_DEPTH_INFO_LEN);
385 static int hclge_get_vf_media_type(struct hclge_vport *vport,
386 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
388 struct hclge_dev *hdev = vport->back;
391 resp_data = hdev->hw.mac.media_type;
392 return hclge_gen_resp_to_vf(vport, mbx_req, 0, &resp_data,
396 static int hclge_get_link_info(struct hclge_vport *vport,
397 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
399 struct hclge_dev *hdev = vport->back;
405 /* mac.link can only be 0 or 1 */
406 link_status = (u16)hdev->hw.mac.link;
407 duplex = hdev->hw.mac.duplex;
408 memcpy(&msg_data[0], &link_status, sizeof(u16));
409 memcpy(&msg_data[2], &hdev->hw.mac.speed, sizeof(u32));
410 memcpy(&msg_data[6], &duplex, sizeof(u16));
411 dest_vfid = mbx_req->mbx_src_vfid;
413 /* send this requested info to VF */
414 return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
415 HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
418 static void hclge_get_link_mode(struct hclge_vport *vport,
419 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
421 #define HCLGE_SUPPORTED 1
422 struct hclge_dev *hdev = vport->back;
423 unsigned long advertising;
424 unsigned long supported;
425 unsigned long send_data;
429 advertising = hdev->hw.mac.advertising[0];
430 supported = hdev->hw.mac.supported[0];
431 dest_vfid = mbx_req->mbx_src_vfid;
432 msg_data[0] = mbx_req->msg[2];
434 send_data = msg_data[0] == HCLGE_SUPPORTED ? supported : advertising;
436 memcpy(&msg_data[2], &send_data, sizeof(unsigned long));
437 hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
438 HCLGE_MBX_LINK_STAT_MODE, dest_vfid);
441 static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport,
442 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
446 memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
448 hclge_reset_vf_queue(vport, queue_id);
450 /* send response msg to VF after queue reset complete*/
451 hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
454 static void hclge_reset_vf(struct hclge_vport *vport,
455 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
457 struct hclge_dev *hdev = vport->back;
460 dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %d!",
463 ret = hclge_func_reset_cmd(hdev, vport->vport_id);
464 hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
467 static void hclge_vf_keep_alive(struct hclge_vport *vport,
468 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
470 vport->last_active_jiffies = jiffies;
473 static int hclge_set_vf_mtu(struct hclge_vport *vport,
474 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
479 memcpy(&mtu, &mbx_req->msg[2], sizeof(mtu));
480 ret = hclge_set_vport_mtu(vport, mtu);
482 return hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
485 static int hclge_get_queue_id_in_pf(struct hclge_vport *vport,
486 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
488 u16 queue_id, qid_in_pf;
491 memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
492 qid_in_pf = hclge_covert_handle_qid_global(&vport->nic, queue_id);
493 memcpy(resp_data, &qid_in_pf, sizeof(qid_in_pf));
495 return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data, 2);
498 static int hclge_get_rss_key(struct hclge_vport *vport,
499 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
501 #define HCLGE_RSS_MBX_RESP_LEN 8
502 u8 resp_data[HCLGE_RSS_MBX_RESP_LEN];
503 struct hclge_dev *hdev = vport->back;
506 index = mbx_req->msg[2];
508 memcpy(&resp_data[0],
509 &hdev->vport[0].rss_hash_key[index * HCLGE_RSS_MBX_RESP_LEN],
510 HCLGE_RSS_MBX_RESP_LEN);
512 return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
513 HCLGE_RSS_MBX_RESP_LEN);
516 static bool hclge_cmd_crq_empty(struct hclge_hw *hw)
518 u32 tail = hclge_read_dev(hw, HCLGE_NIC_CRQ_TAIL_REG);
520 return tail == hw->cmq.crq.next_to_use;
523 void hclge_mbx_handler(struct hclge_dev *hdev)
525 struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
526 struct hclge_mbx_vf_to_pf_cmd *req;
527 struct hclge_vport *vport;
528 struct hclge_desc *desc;
531 /* handle all the mailbox requests in the queue */
532 while (!hclge_cmd_crq_empty(&hdev->hw)) {
533 if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) {
534 dev_warn(&hdev->pdev->dev,
535 "command queue needs re-initializing\n");
539 desc = &crq->desc[crq->next_to_use];
540 req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;
542 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
543 if (unlikely(!hnae3_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B))) {
544 dev_warn(&hdev->pdev->dev,
545 "dropped invalid mailbox message, code = %d\n",
548 /* dropping/not processing this invalid message */
549 crq->desc[crq->next_to_use].flag = 0;
550 hclge_mbx_ring_ptr_move_crq(crq);
554 vport = &hdev->vport[req->mbx_src_vfid];
556 switch (req->msg[0]) {
557 case HCLGE_MBX_MAP_RING_TO_VECTOR:
558 ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
561 case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
562 ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
565 case HCLGE_MBX_SET_PROMISC_MODE:
566 ret = hclge_set_vf_promisc_mode(vport, req);
568 dev_err(&hdev->pdev->dev,
569 "PF fail(%d) to set VF promisc mode\n",
572 case HCLGE_MBX_SET_UNICAST:
573 ret = hclge_set_vf_uc_mac_addr(vport, req, true);
575 dev_err(&hdev->pdev->dev,
576 "PF fail(%d) to set VF UC MAC Addr\n",
579 case HCLGE_MBX_SET_MULTICAST:
580 ret = hclge_set_vf_mc_mac_addr(vport, req, false);
582 dev_err(&hdev->pdev->dev,
583 "PF fail(%d) to set VF MC MAC Addr\n",
586 case HCLGE_MBX_SET_VLAN:
587 ret = hclge_set_vf_vlan_cfg(vport, req, false);
589 dev_err(&hdev->pdev->dev,
590 "PF failed(%d) to config VF's VLAN\n",
593 case HCLGE_MBX_SET_ALIVE:
594 ret = hclge_set_vf_alive(vport, req, false);
596 dev_err(&hdev->pdev->dev,
597 "PF failed(%d) to set VF's ALIVE\n",
600 case HCLGE_MBX_GET_QINFO:
601 ret = hclge_get_vf_queue_info(vport, req, true);
603 dev_err(&hdev->pdev->dev,
604 "PF failed(%d) to get Q info for VF\n",
607 case HCLGE_MBX_GET_QDEPTH:
608 ret = hclge_get_vf_queue_depth(vport, req, true);
610 dev_err(&hdev->pdev->dev,
611 "PF failed(%d) to get Q depth for VF\n",
615 case HCLGE_MBX_GET_TCINFO:
616 ret = hclge_get_vf_tcinfo(vport, req, true);
618 dev_err(&hdev->pdev->dev,
619 "PF failed(%d) to get TC info for VF\n",
622 case HCLGE_MBX_GET_LINK_STATUS:
623 ret = hclge_get_link_info(vport, req);
625 dev_err(&hdev->pdev->dev,
626 "PF fail(%d) to get link stat for VF\n",
629 case HCLGE_MBX_QUEUE_RESET:
630 hclge_mbx_reset_vf_queue(vport, req);
632 case HCLGE_MBX_RESET:
633 hclge_reset_vf(vport, req);
635 case HCLGE_MBX_KEEP_ALIVE:
636 hclge_vf_keep_alive(vport, req);
638 case HCLGE_MBX_SET_MTU:
639 ret = hclge_set_vf_mtu(vport, req);
641 dev_err(&hdev->pdev->dev,
642 "VF fail(%d) to set mtu\n", ret);
644 case HCLGE_MBX_GET_QID_IN_PF:
645 ret = hclge_get_queue_id_in_pf(vport, req);
647 dev_err(&hdev->pdev->dev,
648 "PF failed(%d) to get qid for VF\n",
651 case HCLGE_MBX_GET_RSS_KEY:
652 ret = hclge_get_rss_key(vport, req);
654 dev_err(&hdev->pdev->dev,
655 "PF fail(%d) to get rss key for VF\n",
658 case HCLGE_MBX_GET_LINK_MODE:
659 hclge_get_link_mode(vport, req);
661 case HCLGE_MBX_GET_VF_FLR_STATUS:
662 mutex_lock(&hdev->vport_cfg_mutex);
663 hclge_rm_vport_all_mac_table(vport, true,
665 hclge_rm_vport_all_mac_table(vport, true,
667 hclge_rm_vport_all_vlan_table(vport, true);
668 mutex_unlock(&hdev->vport_cfg_mutex);
670 case HCLGE_MBX_GET_MEDIA_TYPE:
671 ret = hclge_get_vf_media_type(vport, req);
673 dev_err(&hdev->pdev->dev,
674 "PF fail(%d) to media type for VF\n",
678 dev_err(&hdev->pdev->dev,
679 "un-supported mailbox message, code = %d\n",
683 crq->desc[crq->next_to_use].flag = 0;
684 hclge_mbx_ring_ptr_move_crq(crq);
687 /* Write back CMDQ_RQ header pointer, M7 need this pointer */
688 hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);