net: hns3: only support tc 0 for VF
[platform/kernel/linux-rpi.git] / drivers / net / ethernet / hisilicon / hns3 / hns3pf / hclge_mbx.c
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
82 int hclge_inform_reset_assert_to_vf(struct hclge_vport *vport)
83 {
84         struct hclge_dev *hdev = vport->back;
85         enum hnae3_reset_type reset_type;
86         u8 msg_data[2];
87         u8 dest_vfid;
88
89         dest_vfid = (u8)vport->vport_id;
90
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;
95         else
96                 return -EINVAL;
97
98         memcpy(&msg_data[0], &reset_type, sizeof(u16));
99
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);
103 }
104
105 static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
106 {
107         struct hnae3_ring_chain_node *chain_tmp, *chain;
108
109         chain = head->next;
110
111         while (chain) {
112                 chain_tmp = chain->next;
113                 kzfree(chain);
114                 chain = chain_tmp;
115         }
116 }
117
118 /* hclge_get_ring_chain_from_mbx: get ring type & tqp id & int_gl idx
119  * from mailbox message
120  * msg[0]: opcode
121  * msg[1]: <not relevant to this function>
122  * msg[2]: ring_num
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
127  */
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)
132 {
133         struct hnae3_ring_chain_node *cur_chain, *new_chain;
134         int ring_num;
135         int i;
136
137         ring_num = req->msg[2];
138
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))
142                 return -ENOMEM;
143
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,
148                         HNAE3_RING_GL_IDX_S,
149                         req->msg[5]);
150
151         cur_chain = ring_chain;
152
153         for (i = 1; i < ring_num; i++) {
154                 new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
155                 if (!new_chain)
156                         goto err;
157
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]);
161
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]]);
166
167                 hnae3_set_field(new_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
168                                 HNAE3_RING_GL_IDX_S,
169                                 req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
170                                 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);
171
172                 cur_chain->next = new_chain;
173                 cur_chain = new_chain;
174         }
175
176         return 0;
177 err:
178         hclge_free_vector_ring_chain(ring_chain);
179         return -ENOMEM;
180 }
181
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)
184 {
185         struct hnae3_ring_chain_node ring_chain;
186         int vector_id = req->msg[1];
187         int ret;
188
189         memset(&ring_chain, 0, sizeof(ring_chain));
190         ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
191         if (ret)
192                 return ret;
193
194         ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
195         if (ret)
196                 return ret;
197
198         hclge_free_vector_ring_chain(&ring_chain);
199
200         return 0;
201 }
202
203 static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
204                                      struct hclge_mbx_vf_to_pf_cmd *req)
205 {
206         bool en_bc = req->msg[1] ? true : false;
207         struct hclge_promisc_param param;
208
209         /* vf is not allowed to enable unicast/multicast broadcast */
210         hclge_promisc_param_init(&param, false, false, en_bc, vport->vport_id);
211         return hclge_cmd_set_promisc_mode(vport->back, &param);
212 }
213
214 static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
215                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
216                                     bool gen_resp)
217 {
218         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
219         struct hclge_dev *hdev = vport->back;
220         int status;
221
222         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
223                 const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]);
224
225                 hclge_rm_uc_addr_common(vport, old_addr);
226                 status = hclge_add_uc_addr_common(vport, mac_addr);
227                 if (status)
228                         hclge_add_uc_addr_common(vport, old_addr);
229         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
230                 status = hclge_add_uc_addr_common(vport, mac_addr);
231         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
232                 status = hclge_rm_uc_addr_common(vport, mac_addr);
233         } else {
234                 dev_err(&hdev->pdev->dev,
235                         "failed to set unicast mac addr, unknown subcode %d\n",
236                         mbx_req->msg[1]);
237                 return -EIO;
238         }
239
240         if (gen_resp)
241                 hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
242
243         return 0;
244 }
245
246 static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
247                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
248                                     bool gen_resp)
249 {
250         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
251         struct hclge_dev *hdev = vport->back;
252         u8 resp_len = 0;
253         u8 resp_data;
254         int status;
255
256         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
257                 status = hclge_add_mc_addr_common(vport, mac_addr);
258         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
259                 status = hclge_rm_mc_addr_common(vport, mac_addr);
260         } else {
261                 dev_err(&hdev->pdev->dev,
262                         "failed to set mcast mac addr, unknown subcode %d\n",
263                         mbx_req->msg[1]);
264                 return -EIO;
265         }
266
267         if (gen_resp)
268                 hclge_gen_resp_to_vf(vport, mbx_req, status,
269                                      &resp_data, resp_len);
270
271         return 0;
272 }
273
274 static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
275                                  struct hclge_mbx_vf_to_pf_cmd *mbx_req,
276                                  bool gen_resp)
277 {
278         int status = 0;
279
280         if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) {
281                 struct hnae3_handle *handle = &vport->nic;
282                 u16 vlan, proto;
283                 bool is_kill;
284
285                 is_kill = !!mbx_req->msg[2];
286                 memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan));
287                 memcpy(&proto, &mbx_req->msg[5], sizeof(proto));
288                 status = hclge_set_vlan_filter(handle, cpu_to_be16(proto),
289                                                vlan, is_kill);
290         } else if (mbx_req->msg[1] == HCLGE_MBX_VLAN_RX_OFF_CFG) {
291                 struct hnae3_handle *handle = &vport->nic;
292                 bool en = mbx_req->msg[2] ? true : false;
293
294                 status = hclge_en_hw_strip_rxvtag(handle, en);
295         }
296
297         if (gen_resp)
298                 status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
299
300         return status;
301 }
302
303 static int hclge_set_vf_alive(struct hclge_vport *vport,
304                               struct hclge_mbx_vf_to_pf_cmd *mbx_req,
305                               bool gen_resp)
306 {
307         bool alive = !!mbx_req->msg[2];
308         int ret = 0;
309
310         if (alive)
311                 ret = hclge_vport_start(vport);
312         else
313                 hclge_vport_stop(vport);
314
315         return ret;
316 }
317
318 static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
319                                struct hclge_mbx_vf_to_pf_cmd *mbx_req,
320                                bool gen_resp)
321 {
322         struct hnae3_knic_private_info *kinfo = &vport->nic.kinfo;
323         u8 vf_tc_map = 0;
324         int i, ret;
325
326         for (i = 0; i < kinfo->num_tc; i++)
327                 vf_tc_map |= BIT(i);
328
329         ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &vf_tc_map,
330                                    sizeof(u8));
331
332         return ret;
333 }
334
335 static int hclge_get_vf_queue_info(struct hclge_vport *vport,
336                                    struct hclge_mbx_vf_to_pf_cmd *mbx_req,
337                                    bool gen_resp)
338 {
339 #define HCLGE_TQPS_RSS_INFO_LEN         8
340         u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
341         struct hclge_dev *hdev = vport->back;
342
343         /* get the queue related info */
344         memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
345         memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16));
346         memcpy(&resp_data[4], &hdev->num_desc, sizeof(u16));
347         memcpy(&resp_data[6], &hdev->rx_buf_len, sizeof(u16));
348
349         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
350                                     HCLGE_TQPS_RSS_INFO_LEN);
351 }
352
353 static int hclge_get_link_info(struct hclge_vport *vport,
354                                struct hclge_mbx_vf_to_pf_cmd *mbx_req)
355 {
356         struct hclge_dev *hdev = vport->back;
357         u16 link_status;
358         u8 msg_data[8];
359         u8 dest_vfid;
360         u16 duplex;
361
362         /* mac.link can only be 0 or 1 */
363         link_status = (u16)hdev->hw.mac.link;
364         duplex = hdev->hw.mac.duplex;
365         memcpy(&msg_data[0], &link_status, sizeof(u16));
366         memcpy(&msg_data[2], &hdev->hw.mac.speed, sizeof(u32));
367         memcpy(&msg_data[6], &duplex, sizeof(u16));
368         dest_vfid = mbx_req->mbx_src_vfid;
369
370         /* send this requested info to VF */
371         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
372                                   HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
373 }
374
375 static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport,
376                                      struct hclge_mbx_vf_to_pf_cmd *mbx_req)
377 {
378         u16 queue_id;
379
380         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
381
382         hclge_reset_vf_queue(vport, queue_id);
383
384         /* send response msg to VF after queue reset complete*/
385         hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
386 }
387
388 static void hclge_reset_vf(struct hclge_vport *vport,
389                            struct hclge_mbx_vf_to_pf_cmd *mbx_req)
390 {
391         struct hclge_dev *hdev = vport->back;
392         int ret;
393
394         dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %d!",
395                  vport->vport_id);
396
397         ret = hclge_func_reset_cmd(hdev, vport->vport_id);
398         hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
399 }
400
401 static void hclge_vf_keep_alive(struct hclge_vport *vport,
402                                 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
403 {
404         vport->last_active_jiffies = jiffies;
405 }
406
407 static int hclge_set_vf_mtu(struct hclge_vport *vport,
408                             struct hclge_mbx_vf_to_pf_cmd *mbx_req)
409 {
410         int ret;
411         u32 mtu;
412
413         memcpy(&mtu, &mbx_req->msg[2], sizeof(mtu));
414         ret = hclge_set_vport_mtu(vport, mtu);
415
416         return hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
417 }
418
419 static int hclge_get_queue_id_in_pf(struct hclge_vport *vport,
420                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req)
421 {
422         u16 queue_id, qid_in_pf;
423         u8 resp_data[2];
424
425         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
426         qid_in_pf = hclge_covert_handle_qid_global(&vport->nic, queue_id);
427         memcpy(resp_data, &qid_in_pf, sizeof(qid_in_pf));
428
429         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data, 2);
430 }
431
432 static bool hclge_cmd_crq_empty(struct hclge_hw *hw)
433 {
434         u32 tail = hclge_read_dev(hw, HCLGE_NIC_CRQ_TAIL_REG);
435
436         return tail == hw->cmq.crq.next_to_use;
437 }
438
439 void hclge_mbx_handler(struct hclge_dev *hdev)
440 {
441         struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
442         struct hclge_mbx_vf_to_pf_cmd *req;
443         struct hclge_vport *vport;
444         struct hclge_desc *desc;
445         int ret, flag;
446
447         /* handle all the mailbox requests in the queue */
448         while (!hclge_cmd_crq_empty(&hdev->hw)) {
449                 if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) {
450                         dev_warn(&hdev->pdev->dev,
451                                  "command queue needs re-initializing\n");
452                         return;
453                 }
454
455                 desc = &crq->desc[crq->next_to_use];
456                 req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;
457
458                 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
459                 if (unlikely(!hnae3_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B))) {
460                         dev_warn(&hdev->pdev->dev,
461                                  "dropped invalid mailbox message, code = %d\n",
462                                  req->msg[0]);
463
464                         /* dropping/not processing this invalid message */
465                         crq->desc[crq->next_to_use].flag = 0;
466                         hclge_mbx_ring_ptr_move_crq(crq);
467                         continue;
468                 }
469
470                 vport = &hdev->vport[req->mbx_src_vfid];
471
472                 switch (req->msg[0]) {
473                 case HCLGE_MBX_MAP_RING_TO_VECTOR:
474                         ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
475                                                                 req);
476                         break;
477                 case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
478                         ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
479                                                                 req);
480                         break;
481                 case HCLGE_MBX_SET_PROMISC_MODE:
482                         ret = hclge_set_vf_promisc_mode(vport, req);
483                         if (ret)
484                                 dev_err(&hdev->pdev->dev,
485                                         "PF fail(%d) to set VF promisc mode\n",
486                                         ret);
487                         break;
488                 case HCLGE_MBX_SET_UNICAST:
489                         ret = hclge_set_vf_uc_mac_addr(vport, req, true);
490                         if (ret)
491                                 dev_err(&hdev->pdev->dev,
492                                         "PF fail(%d) to set VF UC MAC Addr\n",
493                                         ret);
494                         break;
495                 case HCLGE_MBX_SET_MULTICAST:
496                         ret = hclge_set_vf_mc_mac_addr(vport, req, false);
497                         if (ret)
498                                 dev_err(&hdev->pdev->dev,
499                                         "PF fail(%d) to set VF MC MAC Addr\n",
500                                         ret);
501                         break;
502                 case HCLGE_MBX_SET_VLAN:
503                         ret = hclge_set_vf_vlan_cfg(vport, req, false);
504                         if (ret)
505                                 dev_err(&hdev->pdev->dev,
506                                         "PF failed(%d) to config VF's VLAN\n",
507                                         ret);
508                         break;
509                 case HCLGE_MBX_SET_ALIVE:
510                         ret = hclge_set_vf_alive(vport, req, false);
511                         if (ret)
512                                 dev_err(&hdev->pdev->dev,
513                                         "PF failed(%d) to set VF's ALIVE\n",
514                                         ret);
515                         break;
516                 case HCLGE_MBX_GET_QINFO:
517                         ret = hclge_get_vf_queue_info(vport, req, true);
518                         if (ret)
519                                 dev_err(&hdev->pdev->dev,
520                                         "PF failed(%d) to get Q info for VF\n",
521                                         ret);
522                         break;
523                 case HCLGE_MBX_GET_TCINFO:
524                         ret = hclge_get_vf_tcinfo(vport, req, true);
525                         if (ret)
526                                 dev_err(&hdev->pdev->dev,
527                                         "PF failed(%d) to get TC info for VF\n",
528                                         ret);
529                         break;
530                 case HCLGE_MBX_GET_LINK_STATUS:
531                         ret = hclge_get_link_info(vport, req);
532                         if (ret)
533                                 dev_err(&hdev->pdev->dev,
534                                         "PF fail(%d) to get link stat for VF\n",
535                                         ret);
536                         break;
537                 case HCLGE_MBX_QUEUE_RESET:
538                         hclge_mbx_reset_vf_queue(vport, req);
539                         break;
540                 case HCLGE_MBX_RESET:
541                         hclge_reset_vf(vport, req);
542                         break;
543                 case HCLGE_MBX_KEEP_ALIVE:
544                         hclge_vf_keep_alive(vport, req);
545                         break;
546                 case HCLGE_MBX_SET_MTU:
547                         ret = hclge_set_vf_mtu(vport, req);
548                         if (ret)
549                                 dev_err(&hdev->pdev->dev,
550                                         "VF fail(%d) to set mtu\n", ret);
551                         break;
552                 case HCLGE_MBX_GET_QID_IN_PF:
553                         ret = hclge_get_queue_id_in_pf(vport, req);
554                         if (ret)
555                                 dev_err(&hdev->pdev->dev,
556                                         "PF failed(%d) to get qid for VF\n",
557                                         ret);
558                         break;
559                 default:
560                         dev_err(&hdev->pdev->dev,
561                                 "un-supported mailbox message, code = %d\n",
562                                 req->msg[0]);
563                         break;
564                 }
565                 crq->desc[crq->next_to_use].flag = 0;
566                 hclge_mbx_ring_ptr_move_crq(crq);
567         }
568
569         /* Write back CMDQ_RQ header pointer, M7 need this pointer */
570         hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
571 }