1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2013 - 2018 Intel Corporation. */
3
4 #include "iavf.h"
5 #include "iavf_prototype.h"
6 #include "iavf_client.h"
7
8 /* busy wait delay in msec */
9 #define IAVF_BUSY_WAIT_DELAY 10
10 #define IAVF_BUSY_WAIT_COUNT 50
11
12 /**
13 * iavf_send_pf_msg
14 * @adapter: adapter structure
15 * @op: virtual channel opcode
16 * @msg: pointer to message buffer
17 * @len: message length
18 *
19 * Send message to PF and print status if failure.
20 **/
iavf_send_pf_msg(struct iavf_adapter * adapter,enum virtchnl_ops op,u8 * msg,u16 len)21 static int iavf_send_pf_msg(struct iavf_adapter *adapter,
22 enum virtchnl_ops op, u8 *msg, u16 len)
23 {
24 struct iavf_hw *hw = &adapter->hw;
25 enum iavf_status err;
26
27 if (adapter->flags & IAVF_FLAG_PF_COMMS_FAILED)
28 return 0; /* nothing to see here, move along */
29
30 err = iavf_aq_send_msg_to_pf(hw, op, 0, msg, len, NULL);
31 if (err)
32 dev_dbg(&adapter->pdev->dev, "Unable to send opcode %d to PF, err %s, aq_err %s\n",
33 op, iavf_stat_str(hw, err),
34 iavf_aq_str(hw, hw->aq.asq_last_status));
35 return err;
36 }
37
38 /**
39 * iavf_send_api_ver
40 * @adapter: adapter structure
41 *
42 * Send API version admin queue message to the PF. The reply is not checked
43 * in this function. Returns 0 if the message was successfully
44 * sent, or one of the IAVF_ADMIN_QUEUE_ERROR_ statuses if not.
45 **/
iavf_send_api_ver(struct iavf_adapter * adapter)46 int iavf_send_api_ver(struct iavf_adapter *adapter)
47 {
48 struct virtchnl_version_info vvi;
49
50 vvi.major = VIRTCHNL_VERSION_MAJOR;
51 vvi.minor = VIRTCHNL_VERSION_MINOR;
52
53 return iavf_send_pf_msg(adapter, VIRTCHNL_OP_VERSION, (u8 *)&vvi,
54 sizeof(vvi));
55 }
56
57 /**
58 * iavf_verify_api_ver
59 * @adapter: adapter structure
60 *
61 * Compare API versions with the PF. Must be called after admin queue is
62 * initialized. Returns 0 if API versions match, -EIO if they do not,
63 * IAVF_ERR_ADMIN_QUEUE_NO_WORK if the admin queue is empty, and any errors
64 * from the firmware are propagated.
65 **/
iavf_verify_api_ver(struct iavf_adapter * adapter)66 int iavf_verify_api_ver(struct iavf_adapter *adapter)
67 {
68 struct virtchnl_version_info *pf_vvi;
69 struct iavf_hw *hw = &adapter->hw;
70 struct iavf_arq_event_info event;
71 enum virtchnl_ops op;
72 enum iavf_status err;
73
74 event.buf_len = IAVF_MAX_AQ_BUF_SIZE;
75 event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL);
76 if (!event.msg_buf) {
77 err = -ENOMEM;
78 goto out;
79 }
80
81 while (1) {
82 err = iavf_clean_arq_element(hw, &event, NULL);
83 /* When the AQ is empty, iavf_clean_arq_element will return
84 * nonzero and this loop will terminate.
85 */
86 if (err)
87 goto out_alloc;
88 op =
89 (enum virtchnl_ops)le32_to_cpu(event.desc.cookie_high);
90 if (op == VIRTCHNL_OP_VERSION)
91 break;
92 }
93
94
95 err = (enum iavf_status)le32_to_cpu(event.desc.cookie_low);
96 if (err)
97 goto out_alloc;
98
99 if (op != VIRTCHNL_OP_VERSION) {
100 dev_info(&adapter->pdev->dev, "Invalid reply type %d from PF\n",
101 op);
102 err = -EIO;
103 goto out_alloc;
104 }
105
106 pf_vvi = (struct virtchnl_version_info *)event.msg_buf;
107 adapter->pf_version = *pf_vvi;
108
109 if ((pf_vvi->major > VIRTCHNL_VERSION_MAJOR) ||
110 ((pf_vvi->major == VIRTCHNL_VERSION_MAJOR) &&
111 (pf_vvi->minor > VIRTCHNL_VERSION_MINOR)))
112 err = -EIO;
113
114 out_alloc:
115 kfree(event.msg_buf);
116 out:
117 return err;
118 }
119
120 /**
121 * iavf_send_vf_config_msg
122 * @adapter: adapter structure
123 *
124 * Send VF configuration request admin queue message to the PF. The reply
125 * is not checked in this function. Returns 0 if the message was
126 * successfully sent, or one of the IAVF_ADMIN_QUEUE_ERROR_ statuses if not.
127 **/
iavf_send_vf_config_msg(struct iavf_adapter * adapter)128 int iavf_send_vf_config_msg(struct iavf_adapter *adapter)
129 {
130 u32 caps;
131
132 caps = VIRTCHNL_VF_OFFLOAD_L2 |
133 VIRTCHNL_VF_OFFLOAD_RSS_PF |
134 VIRTCHNL_VF_OFFLOAD_RSS_AQ |
135 VIRTCHNL_VF_OFFLOAD_RSS_REG |
136 VIRTCHNL_VF_OFFLOAD_VLAN |
137 VIRTCHNL_VF_OFFLOAD_WB_ON_ITR |
138 VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2 |
139 VIRTCHNL_VF_OFFLOAD_ENCAP |
140 VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM |
141 VIRTCHNL_VF_OFFLOAD_REQ_QUEUES |
142 VIRTCHNL_VF_OFFLOAD_ADQ |
143 VIRTCHNL_VF_CAP_ADV_LINK_SPEED;
144
145 adapter->current_op = VIRTCHNL_OP_GET_VF_RESOURCES;
146 adapter->aq_required &= ~IAVF_FLAG_AQ_GET_CONFIG;
147 if (PF_IS_V11(adapter))
148 return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
149 (u8 *)&caps, sizeof(caps));
150 else
151 return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
152 NULL, 0);
153 }
154
155 /**
156 * iavf_validate_num_queues
157 * @adapter: adapter structure
158 *
159 * Validate that the number of queues the PF has sent in
160 * VIRTCHNL_OP_GET_VF_RESOURCES is not larger than the VF can handle.
161 **/
iavf_validate_num_queues(struct iavf_adapter * adapter)162 static void iavf_validate_num_queues(struct iavf_adapter *adapter)
163 {
164 if (adapter->vf_res->num_queue_pairs > IAVF_MAX_REQ_QUEUES) {
165 struct virtchnl_vsi_resource *vsi_res;
166 int i;
167
168 dev_info(&adapter->pdev->dev, "Received %d queues, but can only have a max of %d\n",
169 adapter->vf_res->num_queue_pairs,
170 IAVF_MAX_REQ_QUEUES);
171 dev_info(&adapter->pdev->dev, "Fixing by reducing queues to %d\n",
172 IAVF_MAX_REQ_QUEUES);
173 adapter->vf_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
174 for (i = 0; i < adapter->vf_res->num_vsis; i++) {
175 vsi_res = &adapter->vf_res->vsi_res[i];
176 vsi_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
177 }
178 }
179 }
180
181 /**
182 * iavf_get_vf_config
183 * @adapter: private adapter structure
184 *
185 * Get VF configuration from PF and populate hw structure. Must be called after
186 * admin queue is initialized. Busy waits until response is received from PF,
187 * with maximum timeout. Response from PF is returned in the buffer for further
188 * processing by the caller.
189 **/
iavf_get_vf_config(struct iavf_adapter * adapter)190 int iavf_get_vf_config(struct iavf_adapter *adapter)
191 {
192 struct iavf_hw *hw = &adapter->hw;
193 struct iavf_arq_event_info event;
194 enum virtchnl_ops op;
195 enum iavf_status err;
196 u16 len;
197
198 len = sizeof(struct virtchnl_vf_resource) +
199 IAVF_MAX_VF_VSI * sizeof(struct virtchnl_vsi_resource);
200 event.buf_len = len;
201 event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL);
202 if (!event.msg_buf) {
203 err = -ENOMEM;
204 goto out;
205 }
206
207 while (1) {
208 /* When the AQ is empty, iavf_clean_arq_element will return
209 * nonzero and this loop will terminate.
210 */
211 err = iavf_clean_arq_element(hw, &event, NULL);
212 if (err)
213 goto out_alloc;
214 op =
215 (enum virtchnl_ops)le32_to_cpu(event.desc.cookie_high);
216 if (op == VIRTCHNL_OP_GET_VF_RESOURCES)
217 break;
218 }
219
220 err = (enum iavf_status)le32_to_cpu(event.desc.cookie_low);
221 memcpy(adapter->vf_res, event.msg_buf, min(event.msg_len, len));
222
223 /* some PFs send more queues than we should have so validate that
224 * we aren't getting too many queues
225 */
226 if (!err)
227 iavf_validate_num_queues(adapter);
228 iavf_vf_parse_hw_config(hw, adapter->vf_res);
229 out_alloc:
230 kfree(event.msg_buf);
231 out:
232 return err;
233 }
234
235 /**
236 * iavf_configure_queues
237 * @adapter: adapter structure
238 *
239 * Request that the PF set up our (previously allocated) queues.
240 **/
iavf_configure_queues(struct iavf_adapter * adapter)241 void iavf_configure_queues(struct iavf_adapter *adapter)
242 {
243 struct virtchnl_vsi_queue_config_info *vqci;
244 int i, max_frame = adapter->vf_res->max_mtu;
245 int pairs = adapter->num_active_queues;
246 struct virtchnl_queue_pair_info *vqpi;
247 size_t len;
248
249 if (max_frame > IAVF_MAX_RXBUFFER || !max_frame)
250 max_frame = IAVF_MAX_RXBUFFER;
251
252 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
253 /* bail because we already have a command pending */
254 dev_err(&adapter->pdev->dev, "Cannot configure queues, command %d pending\n",
255 adapter->current_op);
256 return;
257 }
258 adapter->current_op = VIRTCHNL_OP_CONFIG_VSI_QUEUES;
259 len = struct_size(vqci, qpair, pairs);
260 vqci = kzalloc(len, GFP_KERNEL);
261 if (!vqci)
262 return;
263
264 /* Limit maximum frame size when jumbo frames is not enabled */
265 if (!(adapter->flags & IAVF_FLAG_LEGACY_RX) &&
266 (adapter->netdev->mtu <= ETH_DATA_LEN))
267 max_frame = IAVF_RXBUFFER_1536 - NET_IP_ALIGN;
268
269 vqci->vsi_id = adapter->vsi_res->vsi_id;
270 vqci->num_queue_pairs = pairs;
271 vqpi = vqci->qpair;
272 /* Size check is not needed here - HW max is 16 queue pairs, and we
273 * can fit info for 31 of them into the AQ buffer before it overflows.
274 */
275 for (i = 0; i < pairs; i++) {
276 vqpi->txq.vsi_id = vqci->vsi_id;
277 vqpi->txq.queue_id = i;
278 vqpi->txq.ring_len = adapter->tx_rings[i].count;
279 vqpi->txq.dma_ring_addr = adapter->tx_rings[i].dma;
280 vqpi->rxq.vsi_id = vqci->vsi_id;
281 vqpi->rxq.queue_id = i;
282 vqpi->rxq.ring_len = adapter->rx_rings[i].count;
283 vqpi->rxq.dma_ring_addr = adapter->rx_rings[i].dma;
284 vqpi->rxq.max_pkt_size = max_frame;
285 vqpi->rxq.databuffer_size =
286 ALIGN(adapter->rx_rings[i].rx_buf_len,
287 BIT_ULL(IAVF_RXQ_CTX_DBUFF_SHIFT));
288 vqpi++;
289 }
290
291 adapter->aq_required &= ~IAVF_FLAG_AQ_CONFIGURE_QUEUES;
292 iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
293 (u8 *)vqci, len);
294 kfree(vqci);
295 }
296
297 /**
298 * iavf_enable_queues
299 * @adapter: adapter structure
300 *
301 * Request that the PF enable all of our queues.
302 **/
iavf_enable_queues(struct iavf_adapter * adapter)303 void iavf_enable_queues(struct iavf_adapter *adapter)
304 {
305 struct virtchnl_queue_select vqs;
306
307 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
308 /* bail because we already have a command pending */
309 dev_err(&adapter->pdev->dev, "Cannot enable queues, command %d pending\n",
310 adapter->current_op);
311 return;
312 }
313 adapter->current_op = VIRTCHNL_OP_ENABLE_QUEUES;
314 vqs.vsi_id = adapter->vsi_res->vsi_id;
315 vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
316 vqs.rx_queues = vqs.tx_queues;
317 adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_QUEUES;
318 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_QUEUES,
319 (u8 *)&vqs, sizeof(vqs));
320 }
321
322 /**
323 * iavf_disable_queues
324 * @adapter: adapter structure
325 *
326 * Request that the PF disable all of our queues.
327 **/
iavf_disable_queues(struct iavf_adapter * adapter)328 void iavf_disable_queues(struct iavf_adapter *adapter)
329 {
330 struct virtchnl_queue_select vqs;
331
332 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
333 /* bail because we already have a command pending */
334 dev_err(&adapter->pdev->dev, "Cannot disable queues, command %d pending\n",
335 adapter->current_op);
336 return;
337 }
338 adapter->current_op = VIRTCHNL_OP_DISABLE_QUEUES;
339 vqs.vsi_id = adapter->vsi_res->vsi_id;
340 vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
341 vqs.rx_queues = vqs.tx_queues;
342 adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_QUEUES;
343 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_QUEUES,
344 (u8 *)&vqs, sizeof(vqs));
345 }
346
347 /**
348 * iavf_map_queues
349 * @adapter: adapter structure
350 *
351 * Request that the PF map queues to interrupt vectors. Misc causes, including
352 * admin queue, are always mapped to vector 0.
353 **/
iavf_map_queues(struct iavf_adapter * adapter)354 void iavf_map_queues(struct iavf_adapter *adapter)
355 {
356 struct virtchnl_irq_map_info *vimi;
357 struct virtchnl_vector_map *vecmap;
358 struct iavf_q_vector *q_vector;
359 int v_idx, q_vectors;
360 size_t len;
361
362 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
363 /* bail because we already have a command pending */
364 dev_err(&adapter->pdev->dev, "Cannot map queues to vectors, command %d pending\n",
365 adapter->current_op);
366 return;
367 }
368 adapter->current_op = VIRTCHNL_OP_CONFIG_IRQ_MAP;
369
370 q_vectors = adapter->num_msix_vectors - NONQ_VECS;
371
372 len = struct_size(vimi, vecmap, adapter->num_msix_vectors);
373 vimi = kzalloc(len, GFP_KERNEL);
374 if (!vimi)
375 return;
376
377 vimi->num_vectors = adapter->num_msix_vectors;
378 /* Queue vectors first */
379 for (v_idx = 0; v_idx < q_vectors; v_idx++) {
380 q_vector = &adapter->q_vectors[v_idx];
381 vecmap = &vimi->vecmap[v_idx];
382
383 vecmap->vsi_id = adapter->vsi_res->vsi_id;
384 vecmap->vector_id = v_idx + NONQ_VECS;
385 vecmap->txq_map = q_vector->ring_mask;
386 vecmap->rxq_map = q_vector->ring_mask;
387 vecmap->rxitr_idx = IAVF_RX_ITR;
388 vecmap->txitr_idx = IAVF_TX_ITR;
389 }
390 /* Misc vector last - this is only for AdminQ messages */
391 vecmap = &vimi->vecmap[v_idx];
392 vecmap->vsi_id = adapter->vsi_res->vsi_id;
393 vecmap->vector_id = 0;
394 vecmap->txq_map = 0;
395 vecmap->rxq_map = 0;
396
397 adapter->aq_required &= ~IAVF_FLAG_AQ_MAP_VECTORS;
398 iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_IRQ_MAP,
399 (u8 *)vimi, len);
400 kfree(vimi);
401 }
402
403 /**
404 * iavf_add_ether_addrs
405 * @adapter: adapter structure
406 *
407 * Request that the PF add one or more addresses to our filters.
408 **/
iavf_add_ether_addrs(struct iavf_adapter * adapter)409 void iavf_add_ether_addrs(struct iavf_adapter *adapter)
410 {
411 struct virtchnl_ether_addr_list *veal;
412 struct iavf_mac_filter *f;
413 int i = 0, count = 0;
414 bool more = false;
415 size_t len;
416
417 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
418 /* bail because we already have a command pending */
419 dev_err(&adapter->pdev->dev, "Cannot add filters, command %d pending\n",
420 adapter->current_op);
421 return;
422 }
423
424 spin_lock_bh(&adapter->mac_vlan_list_lock);
425
426 list_for_each_entry(f, &adapter->mac_filter_list, list) {
427 if (f->add)
428 count++;
429 }
430 if (!count) {
431 adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
432 spin_unlock_bh(&adapter->mac_vlan_list_lock);
433 return;
434 }
435 adapter->current_op = VIRTCHNL_OP_ADD_ETH_ADDR;
436
437 len = struct_size(veal, list, count);
438 if (len > IAVF_MAX_AQ_BUF_SIZE) {
439 dev_warn(&adapter->pdev->dev, "Too many add MAC changes in one request\n");
440 count = (IAVF_MAX_AQ_BUF_SIZE -
441 sizeof(struct virtchnl_ether_addr_list)) /
442 sizeof(struct virtchnl_ether_addr);
443 len = struct_size(veal, list, count);
444 more = true;
445 }
446
447 veal = kzalloc(len, GFP_ATOMIC);
448 if (!veal) {
449 spin_unlock_bh(&adapter->mac_vlan_list_lock);
450 return;
451 }
452
453 veal->vsi_id = adapter->vsi_res->vsi_id;
454 veal->num_elements = count;
455 list_for_each_entry(f, &adapter->mac_filter_list, list) {
456 if (f->add) {
457 ether_addr_copy(veal->list[i].addr, f->macaddr);
458 i++;
459 f->add = false;
460 if (i == count)
461 break;
462 }
463 }
464 if (!more)
465 adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
466
467 spin_unlock_bh(&adapter->mac_vlan_list_lock);
468
469 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_ETH_ADDR, (u8 *)veal, len);
470 kfree(veal);
471 }
472
473 /**
474 * iavf_del_ether_addrs
475 * @adapter: adapter structure
476 *
477 * Request that the PF remove one or more addresses from our filters.
478 **/
iavf_del_ether_addrs(struct iavf_adapter * adapter)479 void iavf_del_ether_addrs(struct iavf_adapter *adapter)
480 {
481 struct virtchnl_ether_addr_list *veal;
482 struct iavf_mac_filter *f, *ftmp;
483 int i = 0, count = 0;
484 bool more = false;
485 size_t len;
486
487 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
488 /* bail because we already have a command pending */
489 dev_err(&adapter->pdev->dev, "Cannot remove filters, command %d pending\n",
490 adapter->current_op);
491 return;
492 }
493
494 spin_lock_bh(&adapter->mac_vlan_list_lock);
495
496 list_for_each_entry(f, &adapter->mac_filter_list, list) {
497 if (f->remove)
498 count++;
499 }
500 if (!count) {
501 adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
502 spin_unlock_bh(&adapter->mac_vlan_list_lock);
503 return;
504 }
505 adapter->current_op = VIRTCHNL_OP_DEL_ETH_ADDR;
506
507 len = struct_size(veal, list, count);
508 if (len > IAVF_MAX_AQ_BUF_SIZE) {
509 dev_warn(&adapter->pdev->dev, "Too many delete MAC changes in one request\n");
510 count = (IAVF_MAX_AQ_BUF_SIZE -
511 sizeof(struct virtchnl_ether_addr_list)) /
512 sizeof(struct virtchnl_ether_addr);
513 len = struct_size(veal, list, count);
514 more = true;
515 }
516 veal = kzalloc(len, GFP_ATOMIC);
517 if (!veal) {
518 spin_unlock_bh(&adapter->mac_vlan_list_lock);
519 return;
520 }
521
522 veal->vsi_id = adapter->vsi_res->vsi_id;
523 veal->num_elements = count;
524 list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
525 if (f->remove) {
526 ether_addr_copy(veal->list[i].addr, f->macaddr);
527 i++;
528 list_del(&f->list);
529 kfree(f);
530 if (i == count)
531 break;
532 }
533 }
534 if (!more)
535 adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
536
537 spin_unlock_bh(&adapter->mac_vlan_list_lock);
538
539 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_ETH_ADDR, (u8 *)veal, len);
540 kfree(veal);
541 }
542
543 /**
544 * iavf_mac_add_ok
545 * @adapter: adapter structure
546 *
547 * Submit list of filters based on PF response.
548 **/
iavf_mac_add_ok(struct iavf_adapter * adapter)549 static void iavf_mac_add_ok(struct iavf_adapter *adapter)
550 {
551 struct iavf_mac_filter *f, *ftmp;
552
553 spin_lock_bh(&adapter->mac_vlan_list_lock);
554 list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
555 f->is_new_mac = false;
556 }
557 spin_unlock_bh(&adapter->mac_vlan_list_lock);
558 }
559
560 /**
561 * iavf_mac_add_reject
562 * @adapter: adapter structure
563 *
564 * Remove filters from list based on PF response.
565 **/
iavf_mac_add_reject(struct iavf_adapter * adapter)566 static void iavf_mac_add_reject(struct iavf_adapter *adapter)
567 {
568 struct net_device *netdev = adapter->netdev;
569 struct iavf_mac_filter *f, *ftmp;
570
571 spin_lock_bh(&adapter->mac_vlan_list_lock);
572 list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
573 if (f->remove && ether_addr_equal(f->macaddr, netdev->dev_addr))
574 f->remove = false;
575
576 if (f->is_new_mac) {
577 list_del(&f->list);
578 kfree(f);
579 }
580 }
581 spin_unlock_bh(&adapter->mac_vlan_list_lock);
582 }
583
584 /**
585 * iavf_add_vlans
586 * @adapter: adapter structure
587 *
588 * Request that the PF add one or more VLAN filters to our VSI.
589 **/
iavf_add_vlans(struct iavf_adapter * adapter)590 void iavf_add_vlans(struct iavf_adapter *adapter)
591 {
592 struct virtchnl_vlan_filter_list *vvfl;
593 int len, i = 0, count = 0;
594 struct iavf_vlan_filter *f;
595 bool more = false;
596
597 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
598 /* bail because we already have a command pending */
599 dev_err(&adapter->pdev->dev, "Cannot add VLANs, command %d pending\n",
600 adapter->current_op);
601 return;
602 }
603
604 spin_lock_bh(&adapter->mac_vlan_list_lock);
605
606 list_for_each_entry(f, &adapter->vlan_filter_list, list) {
607 if (f->add)
608 count++;
609 }
610 if (!count) {
611 adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
612 spin_unlock_bh(&adapter->mac_vlan_list_lock);
613 return;
614 }
615 adapter->current_op = VIRTCHNL_OP_ADD_VLAN;
616
617 len = sizeof(struct virtchnl_vlan_filter_list) +
618 (count * sizeof(u16));
619 if (len > IAVF_MAX_AQ_BUF_SIZE) {
620 dev_warn(&adapter->pdev->dev, "Too many add VLAN changes in one request\n");
621 count = (IAVF_MAX_AQ_BUF_SIZE -
622 sizeof(struct virtchnl_vlan_filter_list)) /
623 sizeof(u16);
624 len = sizeof(struct virtchnl_vlan_filter_list) +
625 (count * sizeof(u16));
626 more = true;
627 }
628 vvfl = kzalloc(len, GFP_ATOMIC);
629 if (!vvfl) {
630 spin_unlock_bh(&adapter->mac_vlan_list_lock);
631 return;
632 }
633
634 vvfl->vsi_id = adapter->vsi_res->vsi_id;
635 vvfl->num_elements = count;
636 list_for_each_entry(f, &adapter->vlan_filter_list, list) {
637 if (f->add) {
638 vvfl->vlan_id[i] = f->vlan;
639 i++;
640 f->add = false;
641 if (i == count)
642 break;
643 }
644 }
645 if (!more)
646 adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
647
648 spin_unlock_bh(&adapter->mac_vlan_list_lock);
649
650 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_VLAN, (u8 *)vvfl, len);
651 kfree(vvfl);
652 }
653
654 /**
655 * iavf_del_vlans
656 * @adapter: adapter structure
657 *
658 * Request that the PF remove one or more VLAN filters from our VSI.
659 **/
iavf_del_vlans(struct iavf_adapter * adapter)660 void iavf_del_vlans(struct iavf_adapter *adapter)
661 {
662 struct virtchnl_vlan_filter_list *vvfl;
663 struct iavf_vlan_filter *f, *ftmp;
664 int len, i = 0, count = 0;
665 bool more = false;
666
667 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
668 /* bail because we already have a command pending */
669 dev_err(&adapter->pdev->dev, "Cannot remove VLANs, command %d pending\n",
670 adapter->current_op);
671 return;
672 }
673
674 spin_lock_bh(&adapter->mac_vlan_list_lock);
675
676 list_for_each_entry(f, &adapter->vlan_filter_list, list) {
677 if (f->remove)
678 count++;
679 }
680 if (!count) {
681 adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
682 spin_unlock_bh(&adapter->mac_vlan_list_lock);
683 return;
684 }
685 adapter->current_op = VIRTCHNL_OP_DEL_VLAN;
686
687 len = sizeof(struct virtchnl_vlan_filter_list) +
688 (count * sizeof(u16));
689 if (len > IAVF_MAX_AQ_BUF_SIZE) {
690 dev_warn(&adapter->pdev->dev, "Too many delete VLAN changes in one request\n");
691 count = (IAVF_MAX_AQ_BUF_SIZE -
692 sizeof(struct virtchnl_vlan_filter_list)) /
693 sizeof(u16);
694 len = sizeof(struct virtchnl_vlan_filter_list) +
695 (count * sizeof(u16));
696 more = true;
697 }
698 vvfl = kzalloc(len, GFP_ATOMIC);
699 if (!vvfl) {
700 spin_unlock_bh(&adapter->mac_vlan_list_lock);
701 return;
702 }
703
704 vvfl->vsi_id = adapter->vsi_res->vsi_id;
705 vvfl->num_elements = count;
706 list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
707 if (f->remove) {
708 vvfl->vlan_id[i] = f->vlan;
709 i++;
710 list_del(&f->list);
711 kfree(f);
712 if (i == count)
713 break;
714 }
715 }
716 if (!more)
717 adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
718
719 spin_unlock_bh(&adapter->mac_vlan_list_lock);
720
721 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_VLAN, (u8 *)vvfl, len);
722 kfree(vvfl);
723 }
724
725 /**
726 * iavf_set_promiscuous
727 * @adapter: adapter structure
728 * @flags: bitmask to control unicast/multicast promiscuous.
729 *
730 * Request that the PF enable promiscuous mode for our VSI.
731 **/
iavf_set_promiscuous(struct iavf_adapter * adapter,int flags)732 void iavf_set_promiscuous(struct iavf_adapter *adapter, int flags)
733 {
734 struct virtchnl_promisc_info vpi;
735 int promisc_all;
736
737 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
738 /* bail because we already have a command pending */
739 dev_err(&adapter->pdev->dev, "Cannot set promiscuous mode, command %d pending\n",
740 adapter->current_op);
741 return;
742 }
743
744 promisc_all = FLAG_VF_UNICAST_PROMISC |
745 FLAG_VF_MULTICAST_PROMISC;
746 if ((flags & promisc_all) == promisc_all) {
747 adapter->flags |= IAVF_FLAG_PROMISC_ON;
748 adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_PROMISC;
749 dev_info(&adapter->pdev->dev, "Entering promiscuous mode\n");
750 }
751
752 if (flags & FLAG_VF_MULTICAST_PROMISC) {
753 adapter->flags |= IAVF_FLAG_ALLMULTI_ON;
754 adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_ALLMULTI;
755 dev_info(&adapter->pdev->dev, "Entering multicast promiscuous mode\n");
756 }
757
758 if (!flags) {
759 adapter->flags &= ~(IAVF_FLAG_PROMISC_ON |
760 IAVF_FLAG_ALLMULTI_ON);
761 adapter->aq_required &= ~(IAVF_FLAG_AQ_RELEASE_PROMISC |
762 IAVF_FLAG_AQ_RELEASE_ALLMULTI);
763 dev_info(&adapter->pdev->dev, "Leaving promiscuous mode\n");
764 }
765
766 adapter->current_op = VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE;
767 vpi.vsi_id = adapter->vsi_res->vsi_id;
768 vpi.flags = flags;
769 iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
770 (u8 *)&vpi, sizeof(vpi));
771 }
772
773 /**
774 * iavf_request_stats
775 * @adapter: adapter structure
776 *
777 * Request VSI statistics from PF.
778 **/
iavf_request_stats(struct iavf_adapter * adapter)779 void iavf_request_stats(struct iavf_adapter *adapter)
780 {
781 struct virtchnl_queue_select vqs;
782
783 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
784 /* no error message, this isn't crucial */
785 return;
786 }
787 adapter->current_op = VIRTCHNL_OP_GET_STATS;
788 vqs.vsi_id = adapter->vsi_res->vsi_id;
789 /* queue maps are ignored for this message - only the vsi is used */
790 if (iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_STATS, (u8 *)&vqs,
791 sizeof(vqs)))
792 /* if the request failed, don't lock out others */
793 adapter->current_op = VIRTCHNL_OP_UNKNOWN;
794 }
795
796 /**
797 * iavf_get_hena
798 * @adapter: adapter structure
799 *
800 * Request hash enable capabilities from PF
801 **/
iavf_get_hena(struct iavf_adapter * adapter)802 void iavf_get_hena(struct iavf_adapter *adapter)
803 {
804 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
805 /* bail because we already have a command pending */
806 dev_err(&adapter->pdev->dev, "Cannot get RSS hash capabilities, command %d pending\n",
807 adapter->current_op);
808 return;
809 }
810 adapter->current_op = VIRTCHNL_OP_GET_RSS_HENA_CAPS;
811 adapter->aq_required &= ~IAVF_FLAG_AQ_GET_HENA;
812 iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_RSS_HENA_CAPS, NULL, 0);
813 }
814
815 /**
816 * iavf_set_hena
817 * @adapter: adapter structure
818 *
819 * Request the PF to set our RSS hash capabilities
820 **/
iavf_set_hena(struct iavf_adapter * adapter)821 void iavf_set_hena(struct iavf_adapter *adapter)
822 {
823 struct virtchnl_rss_hena vrh;
824
825 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
826 /* bail because we already have a command pending */
827 dev_err(&adapter->pdev->dev, "Cannot set RSS hash enable, command %d pending\n",
828 adapter->current_op);
829 return;
830 }
831 vrh.hena = adapter->hena;
832 adapter->current_op = VIRTCHNL_OP_SET_RSS_HENA;
833 adapter->aq_required &= ~IAVF_FLAG_AQ_SET_HENA;
834 iavf_send_pf_msg(adapter, VIRTCHNL_OP_SET_RSS_HENA, (u8 *)&vrh,
835 sizeof(vrh));
836 }
837
838 /**
839 * iavf_set_rss_key
840 * @adapter: adapter structure
841 *
842 * Request the PF to set our RSS hash key
843 **/
iavf_set_rss_key(struct iavf_adapter * adapter)844 void iavf_set_rss_key(struct iavf_adapter *adapter)
845 {
846 struct virtchnl_rss_key *vrk;
847 int len;
848
849 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
850 /* bail because we already have a command pending */
851 dev_err(&adapter->pdev->dev, "Cannot set RSS key, command %d pending\n",
852 adapter->current_op);
853 return;
854 }
855 len = sizeof(struct virtchnl_rss_key) +
856 (adapter->rss_key_size * sizeof(u8)) - 1;
857 vrk = kzalloc(len, GFP_KERNEL);
858 if (!vrk)
859 return;
860 vrk->vsi_id = adapter->vsi.id;
861 vrk->key_len = adapter->rss_key_size;
862 memcpy(vrk->key, adapter->rss_key, adapter->rss_key_size);
863
864 adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_KEY;
865 adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_KEY;
866 iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_KEY, (u8 *)vrk, len);
867 kfree(vrk);
868 }
869
870 /**
871 * iavf_set_rss_lut
872 * @adapter: adapter structure
873 *
874 * Request the PF to set our RSS lookup table
875 **/
iavf_set_rss_lut(struct iavf_adapter * adapter)876 void iavf_set_rss_lut(struct iavf_adapter *adapter)
877 {
878 struct virtchnl_rss_lut *vrl;
879 int len;
880
881 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
882 /* bail because we already have a command pending */
883 dev_err(&adapter->pdev->dev, "Cannot set RSS LUT, command %d pending\n",
884 adapter->current_op);
885 return;
886 }
887 len = sizeof(struct virtchnl_rss_lut) +
888 (adapter->rss_lut_size * sizeof(u8)) - 1;
889 vrl = kzalloc(len, GFP_KERNEL);
890 if (!vrl)
891 return;
892 vrl->vsi_id = adapter->vsi.id;
893 vrl->lut_entries = adapter->rss_lut_size;
894 memcpy(vrl->lut, adapter->rss_lut, adapter->rss_lut_size);
895 adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_LUT;
896 adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_LUT;
897 iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_LUT, (u8 *)vrl, len);
898 kfree(vrl);
899 }
900
901 /**
902 * iavf_enable_vlan_stripping
903 * @adapter: adapter structure
904 *
905 * Request VLAN header stripping to be enabled
906 **/
iavf_enable_vlan_stripping(struct iavf_adapter * adapter)907 void iavf_enable_vlan_stripping(struct iavf_adapter *adapter)
908 {
909 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
910 /* bail because we already have a command pending */
911 dev_err(&adapter->pdev->dev, "Cannot enable stripping, command %d pending\n",
912 adapter->current_op);
913 return;
914 }
915 adapter->current_op = VIRTCHNL_OP_ENABLE_VLAN_STRIPPING;
916 adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_VLAN_STRIPPING;
917 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING, NULL, 0);
918 }
919
920 /**
921 * iavf_disable_vlan_stripping
922 * @adapter: adapter structure
923 *
924 * Request VLAN header stripping to be disabled
925 **/
iavf_disable_vlan_stripping(struct iavf_adapter * adapter)926 void iavf_disable_vlan_stripping(struct iavf_adapter *adapter)
927 {
928 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
929 /* bail because we already have a command pending */
930 dev_err(&adapter->pdev->dev, "Cannot disable stripping, command %d pending\n",
931 adapter->current_op);
932 return;
933 }
934 adapter->current_op = VIRTCHNL_OP_DISABLE_VLAN_STRIPPING;
935 adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_VLAN_STRIPPING;
936 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING, NULL, 0);
937 }
938
939 #define IAVF_MAX_SPEED_STRLEN 13
940
941 /**
942 * iavf_print_link_message - print link up or down
943 * @adapter: adapter structure
944 *
945 * Log a message telling the world of our wonderous link status
946 */
iavf_print_link_message(struct iavf_adapter * adapter)947 static void iavf_print_link_message(struct iavf_adapter *adapter)
948 {
949 struct net_device *netdev = adapter->netdev;
950 int link_speed_mbps;
951 char *speed;
952
953 if (!adapter->link_up) {
954 netdev_info(netdev, "NIC Link is Down\n");
955 return;
956 }
957
958 speed = kcalloc(1, IAVF_MAX_SPEED_STRLEN, GFP_KERNEL);
959 if (!speed)
960 return;
961
962 if (ADV_LINK_SUPPORT(adapter)) {
963 link_speed_mbps = adapter->link_speed_mbps;
964 goto print_link_msg;
965 }
966
967 switch (adapter->link_speed) {
968 case VIRTCHNL_LINK_SPEED_40GB:
969 link_speed_mbps = SPEED_40000;
970 break;
971 case VIRTCHNL_LINK_SPEED_25GB:
972 link_speed_mbps = SPEED_25000;
973 break;
974 case VIRTCHNL_LINK_SPEED_20GB:
975 link_speed_mbps = SPEED_20000;
976 break;
977 case VIRTCHNL_LINK_SPEED_10GB:
978 link_speed_mbps = SPEED_10000;
979 break;
980 case VIRTCHNL_LINK_SPEED_5GB:
981 link_speed_mbps = SPEED_5000;
982 break;
983 case VIRTCHNL_LINK_SPEED_2_5GB:
984 link_speed_mbps = SPEED_2500;
985 break;
986 case VIRTCHNL_LINK_SPEED_1GB:
987 link_speed_mbps = SPEED_1000;
988 break;
989 case VIRTCHNL_LINK_SPEED_100MB:
990 link_speed_mbps = SPEED_100;
991 break;
992 default:
993 link_speed_mbps = SPEED_UNKNOWN;
994 break;
995 }
996
997 print_link_msg:
998 if (link_speed_mbps > SPEED_1000) {
999 if (link_speed_mbps == SPEED_2500)
1000 snprintf(speed, IAVF_MAX_SPEED_STRLEN, "2.5 Gbps");
1001 else
1002 /* convert to Gbps inline */
1003 snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%d %s",
1004 link_speed_mbps / 1000, "Gbps");
1005 } else if (link_speed_mbps == SPEED_UNKNOWN) {
1006 snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%s", "Unknown Mbps");
1007 } else {
1008 snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%u %s",
1009 link_speed_mbps, "Mbps");
1010 }
1011
1012 netdev_info(netdev, "NIC Link is Up Speed is %s Full Duplex\n", speed);
1013 kfree(speed);
1014 }
1015
1016 /**
1017 * iavf_get_vpe_link_status
1018 * @adapter: adapter structure
1019 * @vpe: virtchnl_pf_event structure
1020 *
1021 * Helper function for determining the link status
1022 **/
1023 static bool
iavf_get_vpe_link_status(struct iavf_adapter * adapter,struct virtchnl_pf_event * vpe)1024 iavf_get_vpe_link_status(struct iavf_adapter *adapter,
1025 struct virtchnl_pf_event *vpe)
1026 {
1027 if (ADV_LINK_SUPPORT(adapter))
1028 return vpe->event_data.link_event_adv.link_status;
1029 else
1030 return vpe->event_data.link_event.link_status;
1031 }
1032
1033 /**
1034 * iavf_set_adapter_link_speed_from_vpe
1035 * @adapter: adapter structure for which we are setting the link speed
1036 * @vpe: virtchnl_pf_event structure that contains the link speed we are setting
1037 *
1038 * Helper function for setting iavf_adapter link speed
1039 **/
1040 static void
iavf_set_adapter_link_speed_from_vpe(struct iavf_adapter * adapter,struct virtchnl_pf_event * vpe)1041 iavf_set_adapter_link_speed_from_vpe(struct iavf_adapter *adapter,
1042 struct virtchnl_pf_event *vpe)
1043 {
1044 if (ADV_LINK_SUPPORT(adapter))
1045 adapter->link_speed_mbps =
1046 vpe->event_data.link_event_adv.link_speed;
1047 else
1048 adapter->link_speed = vpe->event_data.link_event.link_speed;
1049 }
1050
1051 /**
1052 * iavf_enable_channel
1053 * @adapter: adapter structure
1054 *
1055 * Request that the PF enable channels as specified by
1056 * the user via tc tool.
1057 **/
iavf_enable_channels(struct iavf_adapter * adapter)1058 void iavf_enable_channels(struct iavf_adapter *adapter)
1059 {
1060 struct virtchnl_tc_info *vti = NULL;
1061 size_t len;
1062 int i;
1063
1064 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1065 /* bail because we already have a command pending */
1066 dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
1067 adapter->current_op);
1068 return;
1069 }
1070
1071 len = struct_size(vti, list, adapter->num_tc - 1);
1072 vti = kzalloc(len, GFP_KERNEL);
1073 if (!vti)
1074 return;
1075 vti->num_tc = adapter->num_tc;
1076 for (i = 0; i < vti->num_tc; i++) {
1077 vti->list[i].count = adapter->ch_config.ch_info[i].count;
1078 vti->list[i].offset = adapter->ch_config.ch_info[i].offset;
1079 vti->list[i].pad = 0;
1080 vti->list[i].max_tx_rate =
1081 adapter->ch_config.ch_info[i].max_tx_rate;
1082 }
1083
1084 adapter->ch_config.state = __IAVF_TC_RUNNING;
1085 adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
1086 adapter->current_op = VIRTCHNL_OP_ENABLE_CHANNELS;
1087 adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_CHANNELS;
1088 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_CHANNELS, (u8 *)vti, len);
1089 kfree(vti);
1090 }
1091
1092 /**
1093 * iavf_disable_channel
1094 * @adapter: adapter structure
1095 *
1096 * Request that the PF disable channels that are configured
1097 **/
iavf_disable_channels(struct iavf_adapter * adapter)1098 void iavf_disable_channels(struct iavf_adapter *adapter)
1099 {
1100 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1101 /* bail because we already have a command pending */
1102 dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
1103 adapter->current_op);
1104 return;
1105 }
1106
1107 adapter->ch_config.state = __IAVF_TC_INVALID;
1108 adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
1109 adapter->current_op = VIRTCHNL_OP_DISABLE_CHANNELS;
1110 adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_CHANNELS;
1111 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_CHANNELS, NULL, 0);
1112 }
1113
1114 /**
1115 * iavf_print_cloud_filter
1116 * @adapter: adapter structure
1117 * @f: cloud filter to print
1118 *
1119 * Print the cloud filter
1120 **/
iavf_print_cloud_filter(struct iavf_adapter * adapter,struct virtchnl_filter * f)1121 static void iavf_print_cloud_filter(struct iavf_adapter *adapter,
1122 struct virtchnl_filter *f)
1123 {
1124 switch (f->flow_type) {
1125 case VIRTCHNL_TCP_V4_FLOW:
1126 dev_info(&adapter->pdev->dev, "dst_mac: %pM src_mac: %pM vlan_id: %hu dst_ip: %pI4 src_ip %pI4 dst_port %hu src_port %hu\n",
1127 &f->data.tcp_spec.dst_mac,
1128 &f->data.tcp_spec.src_mac,
1129 ntohs(f->data.tcp_spec.vlan_id),
1130 &f->data.tcp_spec.dst_ip[0],
1131 &f->data.tcp_spec.src_ip[0],
1132 ntohs(f->data.tcp_spec.dst_port),
1133 ntohs(f->data.tcp_spec.src_port));
1134 break;
1135 case VIRTCHNL_TCP_V6_FLOW:
1136 dev_info(&adapter->pdev->dev, "dst_mac: %pM src_mac: %pM vlan_id: %hu dst_ip: %pI6 src_ip %pI6 dst_port %hu src_port %hu\n",
1137 &f->data.tcp_spec.dst_mac,
1138 &f->data.tcp_spec.src_mac,
1139 ntohs(f->data.tcp_spec.vlan_id),
1140 &f->data.tcp_spec.dst_ip,
1141 &f->data.tcp_spec.src_ip,
1142 ntohs(f->data.tcp_spec.dst_port),
1143 ntohs(f->data.tcp_spec.src_port));
1144 break;
1145 }
1146 }
1147
1148 /**
1149 * iavf_add_cloud_filter
1150 * @adapter: adapter structure
1151 *
1152 * Request that the PF add cloud filters as specified
1153 * by the user via tc tool.
1154 **/
iavf_add_cloud_filter(struct iavf_adapter * adapter)1155 void iavf_add_cloud_filter(struct iavf_adapter *adapter)
1156 {
1157 struct iavf_cloud_filter *cf;
1158 struct virtchnl_filter *f;
1159 int len = 0, count = 0;
1160
1161 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1162 /* bail because we already have a command pending */
1163 dev_err(&adapter->pdev->dev, "Cannot add cloud filter, command %d pending\n",
1164 adapter->current_op);
1165 return;
1166 }
1167 list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1168 if (cf->add) {
1169 count++;
1170 break;
1171 }
1172 }
1173 if (!count) {
1174 adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_CLOUD_FILTER;
1175 return;
1176 }
1177 adapter->current_op = VIRTCHNL_OP_ADD_CLOUD_FILTER;
1178
1179 len = sizeof(struct virtchnl_filter);
1180 f = kzalloc(len, GFP_KERNEL);
1181 if (!f)
1182 return;
1183
1184 list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1185 if (cf->add) {
1186 memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
1187 cf->add = false;
1188 cf->state = __IAVF_CF_ADD_PENDING;
1189 iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_CLOUD_FILTER,
1190 (u8 *)f, len);
1191 }
1192 }
1193 kfree(f);
1194 }
1195
1196 /**
1197 * iavf_del_cloud_filter
1198 * @adapter: adapter structure
1199 *
1200 * Request that the PF delete cloud filters as specified
1201 * by the user via tc tool.
1202 **/
iavf_del_cloud_filter(struct iavf_adapter * adapter)1203 void iavf_del_cloud_filter(struct iavf_adapter *adapter)
1204 {
1205 struct iavf_cloud_filter *cf, *cftmp;
1206 struct virtchnl_filter *f;
1207 int len = 0, count = 0;
1208
1209 if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1210 /* bail because we already have a command pending */
1211 dev_err(&adapter->pdev->dev, "Cannot remove cloud filter, command %d pending\n",
1212 adapter->current_op);
1213 return;
1214 }
1215 list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1216 if (cf->del) {
1217 count++;
1218 break;
1219 }
1220 }
1221 if (!count) {
1222 adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_CLOUD_FILTER;
1223 return;
1224 }
1225 adapter->current_op = VIRTCHNL_OP_DEL_CLOUD_FILTER;
1226
1227 len = sizeof(struct virtchnl_filter);
1228 f = kzalloc(len, GFP_KERNEL);
1229 if (!f)
1230 return;
1231
1232 list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list, list) {
1233 if (cf->del) {
1234 memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
1235 cf->del = false;
1236 cf->state = __IAVF_CF_DEL_PENDING;
1237 iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_CLOUD_FILTER,
1238 (u8 *)f, len);
1239 }
1240 }
1241 kfree(f);
1242 }
1243
1244 /**
1245 * iavf_request_reset
1246 * @adapter: adapter structure
1247 *
1248 * Request that the PF reset this VF. No response is expected.
1249 **/
iavf_request_reset(struct iavf_adapter * adapter)1250 void iavf_request_reset(struct iavf_adapter *adapter)
1251 {
1252 /* Don't check CURRENT_OP - this is always higher priority */
1253 iavf_send_pf_msg(adapter, VIRTCHNL_OP_RESET_VF, NULL, 0);
1254 adapter->current_op = VIRTCHNL_OP_UNKNOWN;
1255 }
1256
1257 /**
1258 * iavf_virtchnl_completion
1259 * @adapter: adapter structure
1260 * @v_opcode: opcode sent by PF
1261 * @v_retval: retval sent by PF
1262 * @msg: message sent by PF
1263 * @msglen: message length
1264 *
1265 * Asynchronous completion function for admin queue messages. Rather than busy
1266 * wait, we fire off our requests and assume that no errors will be returned.
1267 * This function handles the reply messages.
1268 **/
iavf_virtchnl_completion(struct iavf_adapter * adapter,enum virtchnl_ops v_opcode,enum iavf_status v_retval,u8 * msg,u16 msglen)1269 void iavf_virtchnl_completion(struct iavf_adapter *adapter,
1270 enum virtchnl_ops v_opcode,
1271 enum iavf_status v_retval, u8 *msg, u16 msglen)
1272 {
1273 struct net_device *netdev = adapter->netdev;
1274
1275 if (v_opcode == VIRTCHNL_OP_EVENT) {
1276 struct virtchnl_pf_event *vpe =
1277 (struct virtchnl_pf_event *)msg;
1278 bool link_up = iavf_get_vpe_link_status(adapter, vpe);
1279
1280 switch (vpe->event) {
1281 case VIRTCHNL_EVENT_LINK_CHANGE:
1282 iavf_set_adapter_link_speed_from_vpe(adapter, vpe);
1283
1284 /* we've already got the right link status, bail */
1285 if (adapter->link_up == link_up)
1286 break;
1287
1288 if (link_up) {
1289 /* If we get link up message and start queues
1290 * before our queues are configured it will
1291 * trigger a TX hang. In that case, just ignore
1292 * the link status message,we'll get another one
1293 * after we enable queues and actually prepared
1294 * to send traffic.
1295 */
1296 if (adapter->state != __IAVF_RUNNING)
1297 break;
1298
1299 /* For ADq enabled VF, we reconfigure VSIs and
1300 * re-allocate queues. Hence wait till all
1301 * queues are enabled.
1302 */
1303 if (adapter->flags &
1304 IAVF_FLAG_QUEUES_DISABLED)
1305 break;
1306 }
1307
1308 adapter->link_up = link_up;
1309 if (link_up) {
1310 netif_tx_start_all_queues(netdev);
1311 netif_carrier_on(netdev);
1312 } else {
1313 netif_tx_stop_all_queues(netdev);
1314 netif_carrier_off(netdev);
1315 }
1316 iavf_print_link_message(adapter);
1317 break;
1318 case VIRTCHNL_EVENT_RESET_IMPENDING:
1319 dev_info(&adapter->pdev->dev, "Reset warning received from the PF\n");
1320 if (!(adapter->flags & IAVF_FLAG_RESET_PENDING)) {
1321 adapter->flags |= IAVF_FLAG_RESET_PENDING;
1322 dev_info(&adapter->pdev->dev, "Scheduling reset task\n");
1323 queue_work(iavf_wq, &adapter->reset_task);
1324 }
1325 break;
1326 default:
1327 dev_err(&adapter->pdev->dev, "Unknown event %d from PF\n",
1328 vpe->event);
1329 break;
1330 }
1331 return;
1332 }
1333 if (v_retval) {
1334 switch (v_opcode) {
1335 case VIRTCHNL_OP_ADD_VLAN:
1336 dev_err(&adapter->pdev->dev, "Failed to add VLAN filter, error %s\n",
1337 iavf_stat_str(&adapter->hw, v_retval));
1338 break;
1339 case VIRTCHNL_OP_ADD_ETH_ADDR:
1340 dev_err(&adapter->pdev->dev, "Failed to add MAC filter, error %s\n",
1341 iavf_stat_str(&adapter->hw, v_retval));
1342 iavf_mac_add_reject(adapter);
1343 /* restore administratively set MAC address */
1344 ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
1345 break;
1346 case VIRTCHNL_OP_DEL_VLAN:
1347 dev_err(&adapter->pdev->dev, "Failed to delete VLAN filter, error %s\n",
1348 iavf_stat_str(&adapter->hw, v_retval));
1349 break;
1350 case VIRTCHNL_OP_DEL_ETH_ADDR:
1351 dev_err(&adapter->pdev->dev, "Failed to delete MAC filter, error %s\n",
1352 iavf_stat_str(&adapter->hw, v_retval));
1353 break;
1354 case VIRTCHNL_OP_ENABLE_CHANNELS:
1355 dev_err(&adapter->pdev->dev, "Failed to configure queue channels, error %s\n",
1356 iavf_stat_str(&adapter->hw, v_retval));
1357 adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
1358 adapter->ch_config.state = __IAVF_TC_INVALID;
1359 netdev_reset_tc(netdev);
1360 netif_tx_start_all_queues(netdev);
1361 break;
1362 case VIRTCHNL_OP_DISABLE_CHANNELS:
1363 dev_err(&adapter->pdev->dev, "Failed to disable queue channels, error %s\n",
1364 iavf_stat_str(&adapter->hw, v_retval));
1365 adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
1366 adapter->ch_config.state = __IAVF_TC_RUNNING;
1367 netif_tx_start_all_queues(netdev);
1368 break;
1369 case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
1370 struct iavf_cloud_filter *cf, *cftmp;
1371
1372 list_for_each_entry_safe(cf, cftmp,
1373 &adapter->cloud_filter_list,
1374 list) {
1375 if (cf->state == __IAVF_CF_ADD_PENDING) {
1376 cf->state = __IAVF_CF_INVALID;
1377 dev_info(&adapter->pdev->dev, "Failed to add cloud filter, error %s\n",
1378 iavf_stat_str(&adapter->hw,
1379 v_retval));
1380 iavf_print_cloud_filter(adapter,
1381 &cf->f);
1382 list_del(&cf->list);
1383 kfree(cf);
1384 adapter->num_cloud_filters--;
1385 }
1386 }
1387 }
1388 break;
1389 case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
1390 struct iavf_cloud_filter *cf;
1391
1392 list_for_each_entry(cf, &adapter->cloud_filter_list,
1393 list) {
1394 if (cf->state == __IAVF_CF_DEL_PENDING) {
1395 cf->state = __IAVF_CF_ACTIVE;
1396 dev_info(&adapter->pdev->dev, "Failed to del cloud filter, error %s\n",
1397 iavf_stat_str(&adapter->hw,
1398 v_retval));
1399 iavf_print_cloud_filter(adapter,
1400 &cf->f);
1401 }
1402 }
1403 }
1404 break;
1405 default:
1406 dev_err(&adapter->pdev->dev, "PF returned error %d (%s) to our request %d\n",
1407 v_retval, iavf_stat_str(&adapter->hw, v_retval),
1408 v_opcode);
1409 }
1410 }
1411 switch (v_opcode) {
1412 case VIRTCHNL_OP_ADD_ETH_ADDR:
1413 if (!v_retval)
1414 iavf_mac_add_ok(adapter);
1415 if (!ether_addr_equal(netdev->dev_addr, adapter->hw.mac.addr))
1416 ether_addr_copy(netdev->dev_addr, adapter->hw.mac.addr);
1417 break;
1418 case VIRTCHNL_OP_GET_STATS: {
1419 struct iavf_eth_stats *stats =
1420 (struct iavf_eth_stats *)msg;
1421 netdev->stats.rx_packets = stats->rx_unicast +
1422 stats->rx_multicast +
1423 stats->rx_broadcast;
1424 netdev->stats.tx_packets = stats->tx_unicast +
1425 stats->tx_multicast +
1426 stats->tx_broadcast;
1427 netdev->stats.rx_bytes = stats->rx_bytes;
1428 netdev->stats.tx_bytes = stats->tx_bytes;
1429 netdev->stats.tx_errors = stats->tx_errors;
1430 netdev->stats.rx_dropped = stats->rx_discards;
1431 netdev->stats.tx_dropped = stats->tx_discards;
1432 adapter->current_stats = *stats;
1433 }
1434 break;
1435 case VIRTCHNL_OP_GET_VF_RESOURCES: {
1436 u16 len = sizeof(struct virtchnl_vf_resource) +
1437 IAVF_MAX_VF_VSI *
1438 sizeof(struct virtchnl_vsi_resource);
1439 memcpy(adapter->vf_res, msg, min(msglen, len));
1440 iavf_validate_num_queues(adapter);
1441 iavf_vf_parse_hw_config(&adapter->hw, adapter->vf_res);
1442 if (is_zero_ether_addr(adapter->hw.mac.addr)) {
1443 /* restore current mac address */
1444 ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
1445 } else {
1446 /* refresh current mac address if changed */
1447 ether_addr_copy(netdev->dev_addr, adapter->hw.mac.addr);
1448 ether_addr_copy(netdev->perm_addr,
1449 adapter->hw.mac.addr);
1450 }
1451 spin_lock_bh(&adapter->mac_vlan_list_lock);
1452 iavf_add_filter(adapter, adapter->hw.mac.addr);
1453 spin_unlock_bh(&adapter->mac_vlan_list_lock);
1454 iavf_process_config(adapter);
1455 }
1456 break;
1457 case VIRTCHNL_OP_ENABLE_QUEUES:
1458 /* enable transmits */
1459 iavf_irq_enable(adapter, true);
1460 adapter->flags &= ~IAVF_FLAG_QUEUES_DISABLED;
1461 break;
1462 case VIRTCHNL_OP_DISABLE_QUEUES:
1463 iavf_free_all_tx_resources(adapter);
1464 iavf_free_all_rx_resources(adapter);
1465 if (adapter->state == __IAVF_DOWN_PENDING) {
1466 iavf_change_state(adapter, __IAVF_DOWN);
1467 wake_up(&adapter->down_waitqueue);
1468 }
1469 break;
1470 case VIRTCHNL_OP_VERSION:
1471 case VIRTCHNL_OP_CONFIG_IRQ_MAP:
1472 /* Don't display an error if we get these out of sequence.
1473 * If the firmware needed to get kicked, we'll get these and
1474 * it's no problem.
1475 */
1476 if (v_opcode != adapter->current_op)
1477 return;
1478 break;
1479 case VIRTCHNL_OP_IWARP:
1480 /* Gobble zero-length replies from the PF. They indicate that
1481 * a previous message was received OK, and the client doesn't
1482 * care about that.
1483 */
1484 if (msglen && CLIENT_ENABLED(adapter))
1485 iavf_notify_client_message(&adapter->vsi, msg, msglen);
1486 break;
1487
1488 case VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP:
1489 adapter->client_pending &=
1490 ~(BIT(VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP));
1491 break;
1492 case VIRTCHNL_OP_GET_RSS_HENA_CAPS: {
1493 struct virtchnl_rss_hena *vrh = (struct virtchnl_rss_hena *)msg;
1494
1495 if (msglen == sizeof(*vrh))
1496 adapter->hena = vrh->hena;
1497 else
1498 dev_warn(&adapter->pdev->dev,
1499 "Invalid message %d from PF\n", v_opcode);
1500 }
1501 break;
1502 case VIRTCHNL_OP_REQUEST_QUEUES: {
1503 struct virtchnl_vf_res_request *vfres =
1504 (struct virtchnl_vf_res_request *)msg;
1505
1506 if (vfres->num_queue_pairs != adapter->num_req_queues) {
1507 dev_info(&adapter->pdev->dev,
1508 "Requested %d queues, PF can support %d\n",
1509 adapter->num_req_queues,
1510 vfres->num_queue_pairs);
1511 adapter->num_req_queues = 0;
1512 adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
1513 }
1514 }
1515 break;
1516 case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
1517 struct iavf_cloud_filter *cf;
1518
1519 list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1520 if (cf->state == __IAVF_CF_ADD_PENDING)
1521 cf->state = __IAVF_CF_ACTIVE;
1522 }
1523 }
1524 break;
1525 case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
1526 struct iavf_cloud_filter *cf, *cftmp;
1527
1528 list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list,
1529 list) {
1530 if (cf->state == __IAVF_CF_DEL_PENDING) {
1531 cf->state = __IAVF_CF_INVALID;
1532 list_del(&cf->list);
1533 kfree(cf);
1534 adapter->num_cloud_filters--;
1535 }
1536 }
1537 }
1538 break;
1539 default:
1540 if (adapter->current_op && (v_opcode != adapter->current_op))
1541 dev_warn(&adapter->pdev->dev, "Expected response %d from PF, received %d\n",
1542 adapter->current_op, v_opcode);
1543 break;
1544 } /* switch v_opcode */
1545 adapter->current_op = VIRTCHNL_OP_UNKNOWN;
1546 }
1547