da6401d35c0da5a4ddc848b30e1559d93f76329a
[dpdk.git] / drivers / net / iavf / iavf_vchnl.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2017 Intel Corporation
3  */
4
5 #include <stdio.h>
6 #include <errno.h>
7 #include <stdint.h>
8 #include <string.h>
9 #include <unistd.h>
10 #include <stdarg.h>
11 #include <inttypes.h>
12 #include <rte_byteorder.h>
13 #include <rte_common.h>
14
15 #include <rte_debug.h>
16 #include <rte_atomic.h>
17 #include <rte_eal.h>
18 #include <rte_ether.h>
19 #include <rte_ethdev_driver.h>
20 #include <rte_dev.h>
21
22 #include "iavf_log.h"
23 #include "base/iavf_prototype.h"
24 #include "base/iavf_adminq_cmd.h"
25 #include "base/iavf_type.h"
26
27 #include "iavf.h"
28 #include "iavf_rxtx.h"
29
30 #define MAX_TRY_TIMES 200
31 #define ASQ_DELAY_MS  10
32
33 /* Read data in admin queue to get msg from pf driver */
34 static enum iavf_status_code
35 iavf_read_msg_from_pf(struct iavf_adapter *adapter, uint16_t buf_len,
36                      uint8_t *buf)
37 {
38         struct iavf_hw *hw = IAVF_DEV_PRIVATE_TO_HW(adapter);
39         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
40         struct iavf_arq_event_info event;
41         enum virtchnl_ops opcode;
42         int ret;
43
44         event.buf_len = buf_len;
45         event.msg_buf = buf;
46         ret = iavf_clean_arq_element(hw, &event, NULL);
47         /* Can't read any msg from adminQ */
48         if (ret) {
49                 PMD_DRV_LOG(DEBUG, "Can't read msg from AQ");
50                 return ret;
51         }
52
53         opcode = (enum virtchnl_ops)rte_le_to_cpu_32(event.desc.cookie_high);
54         vf->cmd_retval = (enum virtchnl_status_code)rte_le_to_cpu_32(
55                         event.desc.cookie_low);
56
57         PMD_DRV_LOG(DEBUG, "AQ from pf carries opcode %u, retval %d",
58                     opcode, vf->cmd_retval);
59
60         if (opcode != vf->pend_cmd)
61                 PMD_DRV_LOG(WARNING, "command mismatch, expect %u, get %u",
62                             vf->pend_cmd, opcode);
63
64         return IAVF_SUCCESS;
65 }
66
67 static int
68 iavf_execute_vf_cmd(struct iavf_adapter *adapter, struct iavf_cmd_info *args)
69 {
70         struct iavf_hw *hw = IAVF_DEV_PRIVATE_TO_HW(adapter);
71         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
72         enum iavf_status_code ret;
73         int err = 0;
74         int i = 0;
75
76         if (_atomic_set_cmd(vf, args->ops))
77                 return -1;
78
79         ret = iavf_aq_send_msg_to_pf(hw, args->ops, IAVF_SUCCESS,
80                                     args->in_args, args->in_args_size, NULL);
81         if (ret) {
82                 PMD_DRV_LOG(ERR, "fail to send cmd %d", args->ops);
83                 _clear_cmd(vf);
84                 return err;
85         }
86
87         switch (args->ops) {
88         case VIRTCHNL_OP_RESET_VF:
89                 /*no need to wait for response */
90                 _clear_cmd(vf);
91                 break;
92         case VIRTCHNL_OP_VERSION:
93         case VIRTCHNL_OP_GET_VF_RESOURCES:
94                 /* for init virtchnl ops, need to poll the response */
95                 do {
96                         ret = iavf_read_msg_from_pf(adapter, args->out_size,
97                                                    args->out_buffer);
98                         if (ret == IAVF_SUCCESS)
99                                 break;
100                         rte_delay_ms(ASQ_DELAY_MS);
101                 } while (i++ < MAX_TRY_TIMES);
102                 if (i >= MAX_TRY_TIMES ||
103                     vf->cmd_retval != VIRTCHNL_STATUS_SUCCESS) {
104                         err = -1;
105                         PMD_DRV_LOG(ERR, "No response or return failure (%d)"
106                                     " for cmd %d", vf->cmd_retval, args->ops);
107                 }
108                 _clear_cmd(vf);
109                 break;
110
111         default:
112                 /* For other virtchnl ops in running time,
113                  * wait for the cmd done flag.
114                  */
115                 do {
116                         if (vf->pend_cmd == VIRTCHNL_OP_UNKNOWN)
117                                 break;
118                         rte_delay_ms(ASQ_DELAY_MS);
119                         /* If don't read msg or read sys event, continue */
120                 } while (i++ < MAX_TRY_TIMES);
121                 /* If there's no response is received, clear command */
122                 if (i >= MAX_TRY_TIMES  ||
123                     vf->cmd_retval != VIRTCHNL_STATUS_SUCCESS) {
124                         err = -1;
125                         PMD_DRV_LOG(ERR, "No response or return failure (%d)"
126                                     " for cmd %d", vf->cmd_retval, args->ops);
127                         _clear_cmd(vf);
128                 }
129                 break;
130         }
131
132         return err;
133 }
134
135 static void
136 iavf_handle_pf_event_msg(struct rte_eth_dev *dev, uint8_t *msg,
137                         uint16_t msglen)
138 {
139         struct virtchnl_pf_event *pf_msg =
140                         (struct virtchnl_pf_event *)msg;
141         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(dev->data->dev_private);
142
143         if (msglen < sizeof(struct virtchnl_pf_event)) {
144                 PMD_DRV_LOG(DEBUG, "Error event");
145                 return;
146         }
147         switch (pf_msg->event) {
148         case VIRTCHNL_EVENT_RESET_IMPENDING:
149                 PMD_DRV_LOG(DEBUG, "VIRTCHNL_EVENT_RESET_IMPENDING event");
150                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_RESET,
151                                               NULL);
152                 break;
153         case VIRTCHNL_EVENT_LINK_CHANGE:
154                 PMD_DRV_LOG(DEBUG, "VIRTCHNL_EVENT_LINK_CHANGE event");
155                 vf->link_up = pf_msg->event_data.link_event.link_status;
156                 vf->link_speed = pf_msg->event_data.link_event_adv.link_speed;
157                 iavf_dev_link_update(dev, 0);
158                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC,
159                                               NULL);
160                 break;
161         case VIRTCHNL_EVENT_PF_DRIVER_CLOSE:
162                 PMD_DRV_LOG(DEBUG, "VIRTCHNL_EVENT_PF_DRIVER_CLOSE event");
163                 break;
164         default:
165                 PMD_DRV_LOG(ERR, " unknown event received %u", pf_msg->event);
166                 break;
167         }
168 }
169
170 void
171 iavf_handle_virtchnl_msg(struct rte_eth_dev *dev)
172 {
173         struct iavf_hw *hw = IAVF_DEV_PRIVATE_TO_HW(dev->data->dev_private);
174         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(dev->data->dev_private);
175         struct iavf_arq_event_info info;
176         uint16_t pending, aq_opc;
177         enum virtchnl_ops msg_opc;
178         enum iavf_status_code msg_ret;
179         int ret;
180
181         info.buf_len = IAVF_AQ_BUF_SZ;
182         if (!vf->aq_resp) {
183                 PMD_DRV_LOG(ERR, "Buffer for adminq resp should not be NULL");
184                 return;
185         }
186         info.msg_buf = vf->aq_resp;
187
188         pending = 1;
189         while (pending) {
190                 ret = iavf_clean_arq_element(hw, &info, &pending);
191
192                 if (ret != IAVF_SUCCESS) {
193                         PMD_DRV_LOG(INFO, "Failed to read msg from AdminQ,"
194                                     "ret: %d", ret);
195                         break;
196                 }
197                 aq_opc = rte_le_to_cpu_16(info.desc.opcode);
198                 /* For the message sent from pf to vf, opcode is stored in
199                  * cookie_high of struct iavf_aq_desc, while return error code
200                  * are stored in cookie_low, Which is done by PF driver.
201                  */
202                 msg_opc = (enum virtchnl_ops)rte_le_to_cpu_32(
203                                                   info.desc.cookie_high);
204                 msg_ret = (enum iavf_status_code)rte_le_to_cpu_32(
205                                                   info.desc.cookie_low);
206                 switch (aq_opc) {
207                 case iavf_aqc_opc_send_msg_to_vf:
208                         if (msg_opc == VIRTCHNL_OP_EVENT) {
209                                 iavf_handle_pf_event_msg(dev, info.msg_buf,
210                                                         info.msg_len);
211                         } else {
212                                 /* read message and it's expected one */
213                                 if (msg_opc == vf->pend_cmd) {
214                                         vf->cmd_retval = msg_ret;
215                                         /* prevent compiler reordering */
216                                         rte_compiler_barrier();
217                                         _clear_cmd(vf);
218                                 } else
219                                         PMD_DRV_LOG(ERR, "command mismatch,"
220                                                     "expect %u, get %u",
221                                                     vf->pend_cmd, msg_opc);
222                                 PMD_DRV_LOG(DEBUG,
223                                             "adminq response is received,"
224                                             " opcode = %d", msg_opc);
225                         }
226                         break;
227                 default:
228                         PMD_DRV_LOG(ERR, "Request %u is not supported yet",
229                                     aq_opc);
230                         break;
231                 }
232         }
233 }
234
235 int
236 iavf_enable_vlan_strip(struct iavf_adapter *adapter)
237 {
238         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
239         struct iavf_cmd_info args;
240         int ret;
241
242         memset(&args, 0, sizeof(args));
243         args.ops = VIRTCHNL_OP_ENABLE_VLAN_STRIPPING;
244         args.in_args = NULL;
245         args.in_args_size = 0;
246         args.out_buffer = vf->aq_resp;
247         args.out_size = IAVF_AQ_BUF_SZ;
248         ret = iavf_execute_vf_cmd(adapter, &args);
249         if (ret)
250                 PMD_DRV_LOG(ERR, "Failed to execute command of"
251                             " OP_ENABLE_VLAN_STRIPPING");
252
253         return ret;
254 }
255
256 int
257 iavf_disable_vlan_strip(struct iavf_adapter *adapter)
258 {
259         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
260         struct iavf_cmd_info args;
261         int ret;
262
263         memset(&args, 0, sizeof(args));
264         args.ops = VIRTCHNL_OP_DISABLE_VLAN_STRIPPING;
265         args.in_args = NULL;
266         args.in_args_size = 0;
267         args.out_buffer = vf->aq_resp;
268         args.out_size = IAVF_AQ_BUF_SZ;
269         ret = iavf_execute_vf_cmd(adapter, &args);
270         if (ret)
271                 PMD_DRV_LOG(ERR, "Failed to execute command of"
272                             " OP_DISABLE_VLAN_STRIPPING");
273
274         return ret;
275 }
276
277 #define VIRTCHNL_VERSION_MAJOR_START 1
278 #define VIRTCHNL_VERSION_MINOR_START 1
279
280 /* Check API version with sync wait until version read from admin queue */
281 int
282 iavf_check_api_version(struct iavf_adapter *adapter)
283 {
284         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
285         struct virtchnl_version_info version, *pver;
286         struct iavf_cmd_info args;
287         int err;
288
289         version.major = VIRTCHNL_VERSION_MAJOR;
290         version.minor = VIRTCHNL_VERSION_MINOR;
291
292         args.ops = VIRTCHNL_OP_VERSION;
293         args.in_args = (uint8_t *)&version;
294         args.in_args_size = sizeof(version);
295         args.out_buffer = vf->aq_resp;
296         args.out_size = IAVF_AQ_BUF_SZ;
297
298         err = iavf_execute_vf_cmd(adapter, &args);
299         if (err) {
300                 PMD_INIT_LOG(ERR, "Fail to execute command of OP_VERSION");
301                 return err;
302         }
303
304         pver = (struct virtchnl_version_info *)args.out_buffer;
305         vf->virtchnl_version = *pver;
306
307         if (vf->virtchnl_version.major < VIRTCHNL_VERSION_MAJOR_START ||
308             (vf->virtchnl_version.major == VIRTCHNL_VERSION_MAJOR_START &&
309              vf->virtchnl_version.minor < VIRTCHNL_VERSION_MINOR_START)) {
310                 PMD_INIT_LOG(ERR, "VIRTCHNL API version should not be lower"
311                              " than (%u.%u) to support Adapative VF",
312                              VIRTCHNL_VERSION_MAJOR_START,
313                              VIRTCHNL_VERSION_MAJOR_START);
314                 return -1;
315         } else if (vf->virtchnl_version.major > VIRTCHNL_VERSION_MAJOR ||
316                    (vf->virtchnl_version.major == VIRTCHNL_VERSION_MAJOR &&
317                     vf->virtchnl_version.minor > VIRTCHNL_VERSION_MINOR)) {
318                 PMD_INIT_LOG(ERR, "PF/VF API version mismatch:(%u.%u)-(%u.%u)",
319                              vf->virtchnl_version.major,
320                              vf->virtchnl_version.minor,
321                              VIRTCHNL_VERSION_MAJOR,
322                              VIRTCHNL_VERSION_MINOR);
323                 return -1;
324         }
325
326         PMD_DRV_LOG(DEBUG, "Peer is supported PF host");
327         return 0;
328 }
329
330 int
331 iavf_get_vf_resource(struct iavf_adapter *adapter)
332 {
333         struct iavf_hw *hw = IAVF_DEV_PRIVATE_TO_HW(adapter);
334         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
335         struct iavf_cmd_info args;
336         uint32_t caps, len;
337         int err, i;
338
339         args.ops = VIRTCHNL_OP_GET_VF_RESOURCES;
340         args.out_buffer = vf->aq_resp;
341         args.out_size = IAVF_AQ_BUF_SZ;
342
343         /* TODO: basic offload capabilities, need to
344          * add advanced/optional offload capabilities
345          */
346
347         caps = IAVF_BASIC_OFFLOAD_CAPS | VIRTCHNL_VF_CAP_ADV_LINK_SPEED;
348
349         args.in_args = (uint8_t *)&caps;
350         args.in_args_size = sizeof(caps);
351
352         err = iavf_execute_vf_cmd(adapter, &args);
353
354         if (err) {
355                 PMD_DRV_LOG(ERR,
356                             "Failed to execute command of OP_GET_VF_RESOURCE");
357                 return -1;
358         }
359
360         len =  sizeof(struct virtchnl_vf_resource) +
361                       IAVF_MAX_VF_VSI * sizeof(struct virtchnl_vsi_resource);
362
363         rte_memcpy(vf->vf_res, args.out_buffer,
364                    RTE_MIN(args.out_size, len));
365         /* parse  VF config message back from PF*/
366         iavf_parse_hw_config(hw, vf->vf_res);
367         for (i = 0; i < vf->vf_res->num_vsis; i++) {
368                 if (vf->vf_res->vsi_res[i].vsi_type == VIRTCHNL_VSI_SRIOV)
369                         vf->vsi_res = &vf->vf_res->vsi_res[i];
370         }
371
372         if (!vf->vsi_res) {
373                 PMD_INIT_LOG(ERR, "no LAN VSI found");
374                 return -1;
375         }
376
377         vf->vsi.vsi_id = vf->vsi_res->vsi_id;
378         vf->vsi.nb_qps = vf->vsi_res->num_queue_pairs;
379         vf->vsi.adapter = adapter;
380
381         return 0;
382 }
383
384 int
385 iavf_enable_queues(struct iavf_adapter *adapter)
386 {
387         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
388         struct virtchnl_queue_select queue_select;
389         struct iavf_cmd_info args;
390         int err;
391
392         memset(&queue_select, 0, sizeof(queue_select));
393         queue_select.vsi_id = vf->vsi_res->vsi_id;
394
395         queue_select.rx_queues = BIT(adapter->eth_dev->data->nb_rx_queues) - 1;
396         queue_select.tx_queues = BIT(adapter->eth_dev->data->nb_tx_queues) - 1;
397
398         args.ops = VIRTCHNL_OP_ENABLE_QUEUES;
399         args.in_args = (u8 *)&queue_select;
400         args.in_args_size = sizeof(queue_select);
401         args.out_buffer = vf->aq_resp;
402         args.out_size = IAVF_AQ_BUF_SZ;
403         err = iavf_execute_vf_cmd(adapter, &args);
404         if (err) {
405                 PMD_DRV_LOG(ERR,
406                             "Failed to execute command of OP_ENABLE_QUEUES");
407                 return err;
408         }
409         return 0;
410 }
411
412 int
413 iavf_disable_queues(struct iavf_adapter *adapter)
414 {
415         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
416         struct virtchnl_queue_select queue_select;
417         struct iavf_cmd_info args;
418         int err;
419
420         memset(&queue_select, 0, sizeof(queue_select));
421         queue_select.vsi_id = vf->vsi_res->vsi_id;
422
423         queue_select.rx_queues = BIT(adapter->eth_dev->data->nb_rx_queues) - 1;
424         queue_select.tx_queues = BIT(adapter->eth_dev->data->nb_tx_queues) - 1;
425
426         args.ops = VIRTCHNL_OP_DISABLE_QUEUES;
427         args.in_args = (u8 *)&queue_select;
428         args.in_args_size = sizeof(queue_select);
429         args.out_buffer = vf->aq_resp;
430         args.out_size = IAVF_AQ_BUF_SZ;
431         err = iavf_execute_vf_cmd(adapter, &args);
432         if (err) {
433                 PMD_DRV_LOG(ERR,
434                             "Failed to execute command of OP_DISABLE_QUEUES");
435                 return err;
436         }
437         return 0;
438 }
439
440 int
441 iavf_switch_queue(struct iavf_adapter *adapter, uint16_t qid,
442                  bool rx, bool on)
443 {
444         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
445         struct virtchnl_queue_select queue_select;
446         struct iavf_cmd_info args;
447         int err;
448
449         memset(&queue_select, 0, sizeof(queue_select));
450         queue_select.vsi_id = vf->vsi_res->vsi_id;
451         if (rx)
452                 queue_select.rx_queues |= 1 << qid;
453         else
454                 queue_select.tx_queues |= 1 << qid;
455
456         if (on)
457                 args.ops = VIRTCHNL_OP_ENABLE_QUEUES;
458         else
459                 args.ops = VIRTCHNL_OP_DISABLE_QUEUES;
460         args.in_args = (u8 *)&queue_select;
461         args.in_args_size = sizeof(queue_select);
462         args.out_buffer = vf->aq_resp;
463         args.out_size = IAVF_AQ_BUF_SZ;
464         err = iavf_execute_vf_cmd(adapter, &args);
465         if (err)
466                 PMD_DRV_LOG(ERR, "Failed to execute command of %s",
467                             on ? "OP_ENABLE_QUEUES" : "OP_DISABLE_QUEUES");
468         return err;
469 }
470
471 int
472 iavf_configure_rss_lut(struct iavf_adapter *adapter)
473 {
474         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
475         struct virtchnl_rss_lut *rss_lut;
476         struct iavf_cmd_info args;
477         int len, err = 0;
478
479         len = sizeof(*rss_lut) + vf->vf_res->rss_lut_size - 1;
480         rss_lut = rte_zmalloc("rss_lut", len, 0);
481         if (!rss_lut)
482                 return -ENOMEM;
483
484         rss_lut->vsi_id = vf->vsi_res->vsi_id;
485         rss_lut->lut_entries = vf->vf_res->rss_lut_size;
486         rte_memcpy(rss_lut->lut, vf->rss_lut, vf->vf_res->rss_lut_size);
487
488         args.ops = VIRTCHNL_OP_CONFIG_RSS_LUT;
489         args.in_args = (u8 *)rss_lut;
490         args.in_args_size = len;
491         args.out_buffer = vf->aq_resp;
492         args.out_size = IAVF_AQ_BUF_SZ;
493
494         err = iavf_execute_vf_cmd(adapter, &args);
495         if (err)
496                 PMD_DRV_LOG(ERR,
497                             "Failed to execute command of OP_CONFIG_RSS_LUT");
498
499         rte_free(rss_lut);
500         return err;
501 }
502
503 int
504 iavf_configure_rss_key(struct iavf_adapter *adapter)
505 {
506         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
507         struct virtchnl_rss_key *rss_key;
508         struct iavf_cmd_info args;
509         int len, err = 0;
510
511         len = sizeof(*rss_key) + vf->vf_res->rss_key_size - 1;
512         rss_key = rte_zmalloc("rss_key", len, 0);
513         if (!rss_key)
514                 return -ENOMEM;
515
516         rss_key->vsi_id = vf->vsi_res->vsi_id;
517         rss_key->key_len = vf->vf_res->rss_key_size;
518         rte_memcpy(rss_key->key, vf->rss_key, vf->vf_res->rss_key_size);
519
520         args.ops = VIRTCHNL_OP_CONFIG_RSS_KEY;
521         args.in_args = (u8 *)rss_key;
522         args.in_args_size = len;
523         args.out_buffer = vf->aq_resp;
524         args.out_size = IAVF_AQ_BUF_SZ;
525
526         err = iavf_execute_vf_cmd(adapter, &args);
527         if (err)
528                 PMD_DRV_LOG(ERR,
529                             "Failed to execute command of OP_CONFIG_RSS_KEY");
530
531         rte_free(rss_key);
532         return err;
533 }
534
535 int
536 iavf_configure_queues(struct iavf_adapter *adapter)
537 {
538         struct iavf_rx_queue **rxq =
539                 (struct iavf_rx_queue **)adapter->eth_dev->data->rx_queues;
540         struct iavf_tx_queue **txq =
541                 (struct iavf_tx_queue **)adapter->eth_dev->data->tx_queues;
542         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
543         struct virtchnl_vsi_queue_config_info *vc_config;
544         struct virtchnl_queue_pair_info *vc_qp;
545         struct iavf_cmd_info args;
546         uint16_t i, size;
547         int err;
548
549         size = sizeof(*vc_config) +
550                sizeof(vc_config->qpair[0]) * vf->num_queue_pairs;
551         vc_config = rte_zmalloc("cfg_queue", size, 0);
552         if (!vc_config)
553                 return -ENOMEM;
554
555         vc_config->vsi_id = vf->vsi_res->vsi_id;
556         vc_config->num_queue_pairs = vf->num_queue_pairs;
557
558         for (i = 0, vc_qp = vc_config->qpair;
559              i < vf->num_queue_pairs;
560              i++, vc_qp++) {
561                 vc_qp->txq.vsi_id = vf->vsi_res->vsi_id;
562                 vc_qp->txq.queue_id = i;
563                 /* Virtchnnl configure queues by pairs */
564                 if (i < adapter->eth_dev->data->nb_tx_queues) {
565                         vc_qp->txq.ring_len = txq[i]->nb_tx_desc;
566                         vc_qp->txq.dma_ring_addr = txq[i]->tx_ring_phys_addr;
567                 }
568                 vc_qp->rxq.vsi_id = vf->vsi_res->vsi_id;
569                 vc_qp->rxq.queue_id = i;
570                 vc_qp->rxq.max_pkt_size = vf->max_pkt_len;
571                 /* Virtchnnl configure queues by pairs */
572                 if (i < adapter->eth_dev->data->nb_rx_queues) {
573                         vc_qp->rxq.ring_len = rxq[i]->nb_rx_desc;
574                         vc_qp->rxq.dma_ring_addr = rxq[i]->rx_ring_phys_addr;
575                         vc_qp->rxq.databuffer_size = rxq[i]->rx_buf_len;
576                 }
577         }
578
579         memset(&args, 0, sizeof(args));
580         args.ops = VIRTCHNL_OP_CONFIG_VSI_QUEUES;
581         args.in_args = (uint8_t *)vc_config;
582         args.in_args_size = size;
583         args.out_buffer = vf->aq_resp;
584         args.out_size = IAVF_AQ_BUF_SZ;
585
586         err = iavf_execute_vf_cmd(adapter, &args);
587         if (err)
588                 PMD_DRV_LOG(ERR, "Failed to execute command of"
589                             " VIRTCHNL_OP_CONFIG_VSI_QUEUES");
590
591         rte_free(vc_config);
592         return err;
593 }
594
595 int
596 iavf_config_irq_map(struct iavf_adapter *adapter)
597 {
598         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
599         struct virtchnl_irq_map_info *map_info;
600         struct virtchnl_vector_map *vecmap;
601         struct iavf_cmd_info args;
602         int len, i, err;
603
604         len = sizeof(struct virtchnl_irq_map_info) +
605               sizeof(struct virtchnl_vector_map) * vf->nb_msix;
606
607         map_info = rte_zmalloc("map_info", len, 0);
608         if (!map_info)
609                 return -ENOMEM;
610
611         map_info->num_vectors = vf->nb_msix;
612         for (i = 0; i < vf->nb_msix; i++) {
613                 vecmap = &map_info->vecmap[i];
614                 vecmap->vsi_id = vf->vsi_res->vsi_id;
615                 vecmap->rxitr_idx = IAVF_ITR_INDEX_DEFAULT;
616                 vecmap->vector_id = vf->msix_base + i;
617                 vecmap->txq_map = 0;
618                 vecmap->rxq_map = vf->rxq_map[vf->msix_base + i];
619         }
620
621         args.ops = VIRTCHNL_OP_CONFIG_IRQ_MAP;
622         args.in_args = (u8 *)map_info;
623         args.in_args_size = len;
624         args.out_buffer = vf->aq_resp;
625         args.out_size = IAVF_AQ_BUF_SZ;
626         err = iavf_execute_vf_cmd(adapter, &args);
627         if (err)
628                 PMD_DRV_LOG(ERR, "fail to execute command OP_CONFIG_IRQ_MAP");
629
630         rte_free(map_info);
631         return err;
632 }
633
634 void
635 iavf_add_del_all_mac_addr(struct iavf_adapter *adapter, bool add)
636 {
637         struct virtchnl_ether_addr_list *list;
638         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
639         struct ether_addr *addr;
640         struct iavf_cmd_info args;
641         int len, err, i, j;
642         int next_begin = 0;
643         int begin = 0;
644
645         do {
646                 j = 0;
647                 len = sizeof(struct virtchnl_ether_addr_list);
648                 for (i = begin; i < IAVF_NUM_MACADDR_MAX; i++, next_begin++) {
649                         addr = &adapter->eth_dev->data->mac_addrs[i];
650                         if (is_zero_ether_addr(addr))
651                                 continue;
652                         len += sizeof(struct virtchnl_ether_addr);
653                         if (len >= IAVF_AQ_BUF_SZ) {
654                                 next_begin = i + 1;
655                                 break;
656                         }
657                 }
658
659                 list = rte_zmalloc("iavf_del_mac_buffer", len, 0);
660                 if (!list) {
661                         PMD_DRV_LOG(ERR, "fail to allocate memory");
662                         return;
663                 }
664
665                 for (i = begin; i < next_begin; i++) {
666                         addr = &adapter->eth_dev->data->mac_addrs[i];
667                         if (is_zero_ether_addr(addr))
668                                 continue;
669                         rte_memcpy(list->list[j].addr, addr->addr_bytes,
670                                    sizeof(addr->addr_bytes));
671                         PMD_DRV_LOG(DEBUG, "add/rm mac:%x:%x:%x:%x:%x:%x",
672                                     addr->addr_bytes[0], addr->addr_bytes[1],
673                                     addr->addr_bytes[2], addr->addr_bytes[3],
674                                     addr->addr_bytes[4], addr->addr_bytes[5]);
675                         j++;
676                 }
677                 list->vsi_id = vf->vsi_res->vsi_id;
678                 list->num_elements = j;
679                 args.ops = add ? VIRTCHNL_OP_ADD_ETH_ADDR :
680                            VIRTCHNL_OP_DEL_ETH_ADDR;
681                 args.in_args = (uint8_t *)list;
682                 args.in_args_size = len;
683                 args.out_buffer = vf->aq_resp;
684                 args.out_size = IAVF_AQ_BUF_SZ;
685                 err = iavf_execute_vf_cmd(adapter, &args);
686                 if (err)
687                         PMD_DRV_LOG(ERR, "fail to execute command %s",
688                                     add ? "OP_ADD_ETHER_ADDRESS" :
689                                     "OP_DEL_ETHER_ADDRESS");
690                 rte_free(list);
691                 begin = next_begin;
692         } while (begin < IAVF_NUM_MACADDR_MAX);
693 }
694
695 int
696 iavf_query_stats(struct iavf_adapter *adapter,
697                 struct virtchnl_eth_stats **pstats)
698 {
699         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
700         struct virtchnl_queue_select q_stats;
701         struct iavf_cmd_info args;
702         int err;
703
704         memset(&q_stats, 0, sizeof(q_stats));
705         q_stats.vsi_id = vf->vsi_res->vsi_id;
706         args.ops = VIRTCHNL_OP_GET_STATS;
707         args.in_args = (uint8_t *)&q_stats;
708         args.in_args_size = sizeof(q_stats);
709         args.out_buffer = vf->aq_resp;
710         args.out_size = IAVF_AQ_BUF_SZ;
711
712         err = iavf_execute_vf_cmd(adapter, &args);
713         if (err) {
714                 PMD_DRV_LOG(ERR, "fail to execute command OP_GET_STATS");
715                 *pstats = NULL;
716                 return err;
717         }
718         *pstats = (struct virtchnl_eth_stats *)args.out_buffer;
719         return 0;
720 }
721
722 int
723 iavf_config_promisc(struct iavf_adapter *adapter,
724                    bool enable_unicast,
725                    bool enable_multicast)
726 {
727         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
728         struct virtchnl_promisc_info promisc;
729         struct iavf_cmd_info args;
730         int err;
731
732         promisc.flags = 0;
733         promisc.vsi_id = vf->vsi_res->vsi_id;
734
735         if (enable_unicast)
736                 promisc.flags |= FLAG_VF_UNICAST_PROMISC;
737
738         if (enable_multicast)
739                 promisc.flags |= FLAG_VF_MULTICAST_PROMISC;
740
741         args.ops = VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE;
742         args.in_args = (uint8_t *)&promisc;
743         args.in_args_size = sizeof(promisc);
744         args.out_buffer = vf->aq_resp;
745         args.out_size = IAVF_AQ_BUF_SZ;
746
747         err = iavf_execute_vf_cmd(adapter, &args);
748
749         if (err)
750                 PMD_DRV_LOG(ERR,
751                             "fail to execute command CONFIG_PROMISCUOUS_MODE");
752         return err;
753 }
754
755 int
756 iavf_add_del_eth_addr(struct iavf_adapter *adapter, struct ether_addr *addr,
757                      bool add)
758 {
759         struct virtchnl_ether_addr_list *list;
760         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
761         uint8_t cmd_buffer[sizeof(struct virtchnl_ether_addr_list) +
762                            sizeof(struct virtchnl_ether_addr)];
763         struct iavf_cmd_info args;
764         int err;
765
766         list = (struct virtchnl_ether_addr_list *)cmd_buffer;
767         list->vsi_id = vf->vsi_res->vsi_id;
768         list->num_elements = 1;
769         rte_memcpy(list->list[0].addr, addr->addr_bytes,
770                    sizeof(addr->addr_bytes));
771
772         args.ops = add ? VIRTCHNL_OP_ADD_ETH_ADDR : VIRTCHNL_OP_DEL_ETH_ADDR;
773         args.in_args = cmd_buffer;
774         args.in_args_size = sizeof(cmd_buffer);
775         args.out_buffer = vf->aq_resp;
776         args.out_size = IAVF_AQ_BUF_SZ;
777         err = iavf_execute_vf_cmd(adapter, &args);
778         if (err)
779                 PMD_DRV_LOG(ERR, "fail to execute command %s",
780                             add ? "OP_ADD_ETH_ADDR" :  "OP_DEL_ETH_ADDR");
781         return err;
782 }
783
784 int
785 iavf_add_del_vlan(struct iavf_adapter *adapter, uint16_t vlanid, bool add)
786 {
787         struct virtchnl_vlan_filter_list *vlan_list;
788         struct iavf_info *vf = IAVF_DEV_PRIVATE_TO_VF(adapter);
789         uint8_t cmd_buffer[sizeof(struct virtchnl_vlan_filter_list) +
790                                                         sizeof(uint16_t)];
791         struct iavf_cmd_info args;
792         int err;
793
794         vlan_list = (struct virtchnl_vlan_filter_list *)cmd_buffer;
795         vlan_list->vsi_id = vf->vsi_res->vsi_id;
796         vlan_list->num_elements = 1;
797         vlan_list->vlan_id[0] = vlanid;
798
799         args.ops = add ? VIRTCHNL_OP_ADD_VLAN : VIRTCHNL_OP_DEL_VLAN;
800         args.in_args = cmd_buffer;
801         args.in_args_size = sizeof(cmd_buffer);
802         args.out_buffer = vf->aq_resp;
803         args.out_size = IAVF_AQ_BUF_SZ;
804         err = iavf_execute_vf_cmd(adapter, &args);
805         if (err)
806                 PMD_DRV_LOG(ERR, "fail to execute command %s",
807                             add ? "OP_ADD_VLAN" :  "OP_DEL_VLAN");
808
809         return err;
810 }