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 status;
26 
27 	if (adapter->flags & IAVF_FLAG_PF_COMMS_FAILED)
28 		return 0; /* nothing to see here, move along */
29 
30 	status = iavf_aq_send_msg_to_pf(hw, op, 0, msg, len, NULL);
31 	if (status)
32 		dev_dbg(&adapter->pdev->dev, "Unable to send opcode %d to PF, status %s, aq_err %s\n",
33 			op, iavf_stat_str(hw, status),
34 			iavf_aq_str(hw, hw->aq.asq_last_status));
35 	return iavf_status_to_errno(status);
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_poll_virtchnl_msg
59  * @hw: HW configuration structure
60  * @event: event to populate on success
61  * @op_to_poll: requested virtchnl op to poll for
62  *
63  * Initialize poll for virtchnl msg matching the requested_op. Returns 0
64  * if a message of the correct opcode is in the queue or an error code
65  * if no message matching the op code is waiting and other failures.
66  */
67 static int
iavf_poll_virtchnl_msg(struct iavf_hw * hw,struct iavf_arq_event_info * event,enum virtchnl_ops op_to_poll)68 iavf_poll_virtchnl_msg(struct iavf_hw *hw, struct iavf_arq_event_info *event,
69 		       enum virtchnl_ops op_to_poll)
70 {
71 	enum virtchnl_ops received_op;
72 	enum iavf_status status;
73 	u32 v_retval;
74 
75 	while (1) {
76 		/* When the AQ is empty, iavf_clean_arq_element will return
77 		 * nonzero and this loop will terminate.
78 		 */
79 		status = iavf_clean_arq_element(hw, event, NULL);
80 		if (status != IAVF_SUCCESS)
81 			return iavf_status_to_errno(status);
82 		received_op =
83 		    (enum virtchnl_ops)le32_to_cpu(event->desc.cookie_high);
84 		if (op_to_poll == received_op)
85 			break;
86 	}
87 
88 	v_retval = le32_to_cpu(event->desc.cookie_low);
89 	return virtchnl_status_to_errno((enum virtchnl_status_code)v_retval);
90 }
91 
92 /**
93  * iavf_verify_api_ver
94  * @adapter: adapter structure
95  *
96  * Compare API versions with the PF. Must be called after admin queue is
97  * initialized. Returns 0 if API versions match, -EIO if they do not,
98  * IAVF_ERR_ADMIN_QUEUE_NO_WORK if the admin queue is empty, and any errors
99  * from the firmware are propagated.
100  **/
iavf_verify_api_ver(struct iavf_adapter * adapter)101 int iavf_verify_api_ver(struct iavf_adapter *adapter)
102 {
103 	struct iavf_arq_event_info event;
104 	int err;
105 
106 	event.buf_len = IAVF_MAX_AQ_BUF_SIZE;
107 	event.msg_buf = kzalloc(IAVF_MAX_AQ_BUF_SIZE, GFP_KERNEL);
108 	if (!event.msg_buf)
109 		return -ENOMEM;
110 
111 	err = iavf_poll_virtchnl_msg(&adapter->hw, &event, VIRTCHNL_OP_VERSION);
112 	if (!err) {
113 		struct virtchnl_version_info *pf_vvi =
114 			(struct virtchnl_version_info *)event.msg_buf;
115 		adapter->pf_version = *pf_vvi;
116 
117 		if (pf_vvi->major > VIRTCHNL_VERSION_MAJOR ||
118 		    (pf_vvi->major == VIRTCHNL_VERSION_MAJOR &&
119 		     pf_vvi->minor > VIRTCHNL_VERSION_MINOR))
120 			err = -EIO;
121 	}
122 
123 	kfree(event.msg_buf);
124 
125 	return err;
126 }
127 
128 /**
129  * iavf_send_vf_config_msg
130  * @adapter: adapter structure
131  *
132  * Send VF configuration request admin queue message to the PF. The reply
133  * is not checked in this function. Returns 0 if the message was
134  * successfully sent, or one of the IAVF_ADMIN_QUEUE_ERROR_ statuses if not.
135  **/
iavf_send_vf_config_msg(struct iavf_adapter * adapter)136 int iavf_send_vf_config_msg(struct iavf_adapter *adapter)
137 {
138 	u32 caps;
139 
140 	caps = VIRTCHNL_VF_OFFLOAD_L2 |
141 	       VIRTCHNL_VF_OFFLOAD_RSS_PF |
142 	       VIRTCHNL_VF_OFFLOAD_RSS_AQ |
143 	       VIRTCHNL_VF_OFFLOAD_RSS_REG |
144 	       VIRTCHNL_VF_OFFLOAD_VLAN |
145 	       VIRTCHNL_VF_OFFLOAD_WB_ON_ITR |
146 	       VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2 |
147 	       VIRTCHNL_VF_OFFLOAD_ENCAP |
148 	       VIRTCHNL_VF_OFFLOAD_VLAN_V2 |
149 	       VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM |
150 	       VIRTCHNL_VF_OFFLOAD_REQ_QUEUES |
151 	       VIRTCHNL_VF_OFFLOAD_ADQ |
152 	       VIRTCHNL_VF_OFFLOAD_USO |
153 	       VIRTCHNL_VF_OFFLOAD_FDIR_PF |
154 	       VIRTCHNL_VF_OFFLOAD_ADV_RSS_PF |
155 	       VIRTCHNL_VF_CAP_ADV_LINK_SPEED;
156 
157 	adapter->current_op = VIRTCHNL_OP_GET_VF_RESOURCES;
158 	adapter->aq_required &= ~IAVF_FLAG_AQ_GET_CONFIG;
159 	if (PF_IS_V11(adapter))
160 		return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
161 					(u8 *)&caps, sizeof(caps));
162 	else
163 		return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
164 					NULL, 0);
165 }
166 
iavf_send_vf_offload_vlan_v2_msg(struct iavf_adapter * adapter)167 int iavf_send_vf_offload_vlan_v2_msg(struct iavf_adapter *adapter)
168 {
169 	adapter->aq_required &= ~IAVF_FLAG_AQ_GET_OFFLOAD_VLAN_V2_CAPS;
170 
171 	if (!VLAN_V2_ALLOWED(adapter))
172 		return -EOPNOTSUPP;
173 
174 	adapter->current_op = VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS;
175 
176 	return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS,
177 				NULL, 0);
178 }
179 
180 /**
181  * iavf_validate_num_queues
182  * @adapter: adapter structure
183  *
184  * Validate that the number of queues the PF has sent in
185  * VIRTCHNL_OP_GET_VF_RESOURCES is not larger than the VF can handle.
186  **/
iavf_validate_num_queues(struct iavf_adapter * adapter)187 static void iavf_validate_num_queues(struct iavf_adapter *adapter)
188 {
189 	if (adapter->vf_res->num_queue_pairs > IAVF_MAX_REQ_QUEUES) {
190 		struct virtchnl_vsi_resource *vsi_res;
191 		int i;
192 
193 		dev_info(&adapter->pdev->dev, "Received %d queues, but can only have a max of %d\n",
194 			 adapter->vf_res->num_queue_pairs,
195 			 IAVF_MAX_REQ_QUEUES);
196 		dev_info(&adapter->pdev->dev, "Fixing by reducing queues to %d\n",
197 			 IAVF_MAX_REQ_QUEUES);
198 		adapter->vf_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
199 		for (i = 0; i < adapter->vf_res->num_vsis; i++) {
200 			vsi_res = &adapter->vf_res->vsi_res[i];
201 			vsi_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
202 		}
203 	}
204 }
205 
206 /**
207  * iavf_get_vf_config
208  * @adapter: private adapter structure
209  *
210  * Get VF configuration from PF and populate hw structure. Must be called after
211  * admin queue is initialized. Busy waits until response is received from PF,
212  * with maximum timeout. Response from PF is returned in the buffer for further
213  * processing by the caller.
214  **/
iavf_get_vf_config(struct iavf_adapter * adapter)215 int iavf_get_vf_config(struct iavf_adapter *adapter)
216 {
217 	struct iavf_hw *hw = &adapter->hw;
218 	struct iavf_arq_event_info event;
219 	u16 len;
220 	int err;
221 
222 	len = sizeof(struct virtchnl_vf_resource) +
223 		IAVF_MAX_VF_VSI * sizeof(struct virtchnl_vsi_resource);
224 	event.buf_len = len;
225 	event.msg_buf = kzalloc(len, GFP_KERNEL);
226 	if (!event.msg_buf)
227 		return -ENOMEM;
228 
229 	err = iavf_poll_virtchnl_msg(hw, &event, VIRTCHNL_OP_GET_VF_RESOURCES);
230 	memcpy(adapter->vf_res, event.msg_buf, min(event.msg_len, len));
231 
232 	/* some PFs send more queues than we should have so validate that
233 	 * we aren't getting too many queues
234 	 */
235 	if (!err)
236 		iavf_validate_num_queues(adapter);
237 	iavf_vf_parse_hw_config(hw, adapter->vf_res);
238 
239 	kfree(event.msg_buf);
240 
241 	return err;
242 }
243 
iavf_get_vf_vlan_v2_caps(struct iavf_adapter * adapter)244 int iavf_get_vf_vlan_v2_caps(struct iavf_adapter *adapter)
245 {
246 	struct iavf_arq_event_info event;
247 	int err;
248 	u16 len;
249 
250 	len = sizeof(struct virtchnl_vlan_caps);
251 	event.buf_len = len;
252 	event.msg_buf = kzalloc(len, GFP_KERNEL);
253 	if (!event.msg_buf)
254 		return -ENOMEM;
255 
256 	err = iavf_poll_virtchnl_msg(&adapter->hw, &event,
257 				     VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS);
258 	if (!err)
259 		memcpy(&adapter->vlan_v2_caps, event.msg_buf,
260 		       min(event.msg_len, len));
261 
262 	kfree(event.msg_buf);
263 
264 	return err;
265 }
266 
267 /**
268  * iavf_configure_queues
269  * @adapter: adapter structure
270  *
271  * Request that the PF set up our (previously allocated) queues.
272  **/
iavf_configure_queues(struct iavf_adapter * adapter)273 void iavf_configure_queues(struct iavf_adapter *adapter)
274 {
275 	struct virtchnl_vsi_queue_config_info *vqci;
276 	struct virtchnl_queue_pair_info *vqpi;
277 	int pairs = adapter->num_active_queues;
278 	int i, max_frame = IAVF_MAX_RXBUFFER;
279 	size_t len;
280 
281 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
282 		/* bail because we already have a command pending */
283 		dev_err(&adapter->pdev->dev, "Cannot configure queues, command %d pending\n",
284 			adapter->current_op);
285 		return;
286 	}
287 	adapter->current_op = VIRTCHNL_OP_CONFIG_VSI_QUEUES;
288 	len = struct_size(vqci, qpair, pairs);
289 	vqci = kzalloc(len, GFP_KERNEL);
290 	if (!vqci)
291 		return;
292 
293 	/* Limit maximum frame size when jumbo frames is not enabled */
294 	if (!(adapter->flags & IAVF_FLAG_LEGACY_RX) &&
295 	    (adapter->netdev->mtu <= ETH_DATA_LEN))
296 		max_frame = IAVF_RXBUFFER_1536 - NET_IP_ALIGN;
297 
298 	vqci->vsi_id = adapter->vsi_res->vsi_id;
299 	vqci->num_queue_pairs = pairs;
300 	vqpi = vqci->qpair;
301 	/* Size check is not needed here - HW max is 16 queue pairs, and we
302 	 * can fit info for 31 of them into the AQ buffer before it overflows.
303 	 */
304 	for (i = 0; i < pairs; i++) {
305 		vqpi->txq.vsi_id = vqci->vsi_id;
306 		vqpi->txq.queue_id = i;
307 		vqpi->txq.ring_len = adapter->tx_rings[i].count;
308 		vqpi->txq.dma_ring_addr = adapter->tx_rings[i].dma;
309 		vqpi->rxq.vsi_id = vqci->vsi_id;
310 		vqpi->rxq.queue_id = i;
311 		vqpi->rxq.ring_len = adapter->rx_rings[i].count;
312 		vqpi->rxq.dma_ring_addr = adapter->rx_rings[i].dma;
313 		vqpi->rxq.max_pkt_size = max_frame;
314 		vqpi->rxq.databuffer_size =
315 			ALIGN(adapter->rx_rings[i].rx_buf_len,
316 			      BIT_ULL(IAVF_RXQ_CTX_DBUFF_SHIFT));
317 		vqpi++;
318 	}
319 
320 	adapter->aq_required &= ~IAVF_FLAG_AQ_CONFIGURE_QUEUES;
321 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
322 			 (u8 *)vqci, len);
323 	kfree(vqci);
324 }
325 
326 /**
327  * iavf_enable_queues
328  * @adapter: adapter structure
329  *
330  * Request that the PF enable all of our queues.
331  **/
iavf_enable_queues(struct iavf_adapter * adapter)332 void iavf_enable_queues(struct iavf_adapter *adapter)
333 {
334 	struct virtchnl_queue_select vqs;
335 
336 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
337 		/* bail because we already have a command pending */
338 		dev_err(&adapter->pdev->dev, "Cannot enable queues, command %d pending\n",
339 			adapter->current_op);
340 		return;
341 	}
342 	adapter->current_op = VIRTCHNL_OP_ENABLE_QUEUES;
343 	vqs.vsi_id = adapter->vsi_res->vsi_id;
344 	vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
345 	vqs.rx_queues = vqs.tx_queues;
346 	adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_QUEUES;
347 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_QUEUES,
348 			 (u8 *)&vqs, sizeof(vqs));
349 }
350 
351 /**
352  * iavf_disable_queues
353  * @adapter: adapter structure
354  *
355  * Request that the PF disable all of our queues.
356  **/
iavf_disable_queues(struct iavf_adapter * adapter)357 void iavf_disable_queues(struct iavf_adapter *adapter)
358 {
359 	struct virtchnl_queue_select vqs;
360 
361 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
362 		/* bail because we already have a command pending */
363 		dev_err(&adapter->pdev->dev, "Cannot disable queues, command %d pending\n",
364 			adapter->current_op);
365 		return;
366 	}
367 	adapter->current_op = VIRTCHNL_OP_DISABLE_QUEUES;
368 	vqs.vsi_id = adapter->vsi_res->vsi_id;
369 	vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
370 	vqs.rx_queues = vqs.tx_queues;
371 	adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_QUEUES;
372 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_QUEUES,
373 			 (u8 *)&vqs, sizeof(vqs));
374 }
375 
376 /**
377  * iavf_map_queues
378  * @adapter: adapter structure
379  *
380  * Request that the PF map queues to interrupt vectors. Misc causes, including
381  * admin queue, are always mapped to vector 0.
382  **/
iavf_map_queues(struct iavf_adapter * adapter)383 void iavf_map_queues(struct iavf_adapter *adapter)
384 {
385 	struct virtchnl_irq_map_info *vimi;
386 	struct virtchnl_vector_map *vecmap;
387 	struct iavf_q_vector *q_vector;
388 	int v_idx, q_vectors;
389 	size_t len;
390 
391 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
392 		/* bail because we already have a command pending */
393 		dev_err(&adapter->pdev->dev, "Cannot map queues to vectors, command %d pending\n",
394 			adapter->current_op);
395 		return;
396 	}
397 	adapter->current_op = VIRTCHNL_OP_CONFIG_IRQ_MAP;
398 
399 	q_vectors = adapter->num_msix_vectors - NONQ_VECS;
400 
401 	len = struct_size(vimi, vecmap, adapter->num_msix_vectors);
402 	vimi = kzalloc(len, GFP_KERNEL);
403 	if (!vimi)
404 		return;
405 
406 	vimi->num_vectors = adapter->num_msix_vectors;
407 	/* Queue vectors first */
408 	for (v_idx = 0; v_idx < q_vectors; v_idx++) {
409 		q_vector = &adapter->q_vectors[v_idx];
410 		vecmap = &vimi->vecmap[v_idx];
411 
412 		vecmap->vsi_id = adapter->vsi_res->vsi_id;
413 		vecmap->vector_id = v_idx + NONQ_VECS;
414 		vecmap->txq_map = q_vector->ring_mask;
415 		vecmap->rxq_map = q_vector->ring_mask;
416 		vecmap->rxitr_idx = IAVF_RX_ITR;
417 		vecmap->txitr_idx = IAVF_TX_ITR;
418 	}
419 	/* Misc vector last - this is only for AdminQ messages */
420 	vecmap = &vimi->vecmap[v_idx];
421 	vecmap->vsi_id = adapter->vsi_res->vsi_id;
422 	vecmap->vector_id = 0;
423 	vecmap->txq_map = 0;
424 	vecmap->rxq_map = 0;
425 
426 	adapter->aq_required &= ~IAVF_FLAG_AQ_MAP_VECTORS;
427 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_IRQ_MAP,
428 			 (u8 *)vimi, len);
429 	kfree(vimi);
430 }
431 
432 /**
433  * iavf_set_mac_addr_type - Set the correct request type from the filter type
434  * @virtchnl_ether_addr: pointer to requested list element
435  * @filter: pointer to requested filter
436  **/
437 static void
iavf_set_mac_addr_type(struct virtchnl_ether_addr * virtchnl_ether_addr,const struct iavf_mac_filter * filter)438 iavf_set_mac_addr_type(struct virtchnl_ether_addr *virtchnl_ether_addr,
439 		       const struct iavf_mac_filter *filter)
440 {
441 	virtchnl_ether_addr->type = filter->is_primary ?
442 		VIRTCHNL_ETHER_ADDR_PRIMARY :
443 		VIRTCHNL_ETHER_ADDR_EXTRA;
444 }
445 
446 /**
447  * iavf_add_ether_addrs
448  * @adapter: adapter structure
449  *
450  * Request that the PF add one or more addresses to our filters.
451  **/
iavf_add_ether_addrs(struct iavf_adapter * adapter)452 void iavf_add_ether_addrs(struct iavf_adapter *adapter)
453 {
454 	struct virtchnl_ether_addr_list *veal;
455 	struct iavf_mac_filter *f;
456 	int i = 0, count = 0;
457 	bool more = false;
458 	size_t len;
459 
460 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
461 		/* bail because we already have a command pending */
462 		dev_err(&adapter->pdev->dev, "Cannot add filters, command %d pending\n",
463 			adapter->current_op);
464 		return;
465 	}
466 
467 	spin_lock_bh(&adapter->mac_vlan_list_lock);
468 
469 	list_for_each_entry(f, &adapter->mac_filter_list, list) {
470 		if (f->add)
471 			count++;
472 	}
473 	if (!count) {
474 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
475 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
476 		return;
477 	}
478 	adapter->current_op = VIRTCHNL_OP_ADD_ETH_ADDR;
479 
480 	len = struct_size(veal, list, count);
481 	if (len > IAVF_MAX_AQ_BUF_SIZE) {
482 		dev_warn(&adapter->pdev->dev, "Too many add MAC changes in one request\n");
483 		count = (IAVF_MAX_AQ_BUF_SIZE -
484 			 sizeof(struct virtchnl_ether_addr_list)) /
485 			sizeof(struct virtchnl_ether_addr);
486 		len = struct_size(veal, list, count);
487 		more = true;
488 	}
489 
490 	veal = kzalloc(len, GFP_ATOMIC);
491 	if (!veal) {
492 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
493 		return;
494 	}
495 
496 	veal->vsi_id = adapter->vsi_res->vsi_id;
497 	veal->num_elements = count;
498 	list_for_each_entry(f, &adapter->mac_filter_list, list) {
499 		if (f->add) {
500 			ether_addr_copy(veal->list[i].addr, f->macaddr);
501 			iavf_set_mac_addr_type(&veal->list[i], f);
502 			i++;
503 			f->add = false;
504 			if (i == count)
505 				break;
506 		}
507 	}
508 	if (!more)
509 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
510 
511 	spin_unlock_bh(&adapter->mac_vlan_list_lock);
512 
513 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_ETH_ADDR, (u8 *)veal, len);
514 	kfree(veal);
515 }
516 
517 /**
518  * iavf_del_ether_addrs
519  * @adapter: adapter structure
520  *
521  * Request that the PF remove one or more addresses from our filters.
522  **/
iavf_del_ether_addrs(struct iavf_adapter * adapter)523 void iavf_del_ether_addrs(struct iavf_adapter *adapter)
524 {
525 	struct virtchnl_ether_addr_list *veal;
526 	struct iavf_mac_filter *f, *ftmp;
527 	int i = 0, count = 0;
528 	bool more = false;
529 	size_t len;
530 
531 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
532 		/* bail because we already have a command pending */
533 		dev_err(&adapter->pdev->dev, "Cannot remove filters, command %d pending\n",
534 			adapter->current_op);
535 		return;
536 	}
537 
538 	spin_lock_bh(&adapter->mac_vlan_list_lock);
539 
540 	list_for_each_entry(f, &adapter->mac_filter_list, list) {
541 		if (f->remove)
542 			count++;
543 	}
544 	if (!count) {
545 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
546 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
547 		return;
548 	}
549 	adapter->current_op = VIRTCHNL_OP_DEL_ETH_ADDR;
550 
551 	len = struct_size(veal, list, count);
552 	if (len > IAVF_MAX_AQ_BUF_SIZE) {
553 		dev_warn(&adapter->pdev->dev, "Too many delete MAC changes in one request\n");
554 		count = (IAVF_MAX_AQ_BUF_SIZE -
555 			 sizeof(struct virtchnl_ether_addr_list)) /
556 			sizeof(struct virtchnl_ether_addr);
557 		len = struct_size(veal, list, count);
558 		more = true;
559 	}
560 	veal = kzalloc(len, GFP_ATOMIC);
561 	if (!veal) {
562 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
563 		return;
564 	}
565 
566 	veal->vsi_id = adapter->vsi_res->vsi_id;
567 	veal->num_elements = count;
568 	list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
569 		if (f->remove) {
570 			ether_addr_copy(veal->list[i].addr, f->macaddr);
571 			iavf_set_mac_addr_type(&veal->list[i], f);
572 			i++;
573 			list_del(&f->list);
574 			kfree(f);
575 			if (i == count)
576 				break;
577 		}
578 	}
579 	if (!more)
580 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
581 
582 	spin_unlock_bh(&adapter->mac_vlan_list_lock);
583 
584 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_ETH_ADDR, (u8 *)veal, len);
585 	kfree(veal);
586 }
587 
588 /**
589  * iavf_mac_add_ok
590  * @adapter: adapter structure
591  *
592  * Submit list of filters based on PF response.
593  **/
iavf_mac_add_ok(struct iavf_adapter * adapter)594 static void iavf_mac_add_ok(struct iavf_adapter *adapter)
595 {
596 	struct iavf_mac_filter *f, *ftmp;
597 
598 	spin_lock_bh(&adapter->mac_vlan_list_lock);
599 	list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
600 		f->is_new_mac = false;
601 	}
602 	spin_unlock_bh(&adapter->mac_vlan_list_lock);
603 }
604 
605 /**
606  * iavf_mac_add_reject
607  * @adapter: adapter structure
608  *
609  * Remove filters from list based on PF response.
610  **/
iavf_mac_add_reject(struct iavf_adapter * adapter)611 static void iavf_mac_add_reject(struct iavf_adapter *adapter)
612 {
613 	struct net_device *netdev = adapter->netdev;
614 	struct iavf_mac_filter *f, *ftmp;
615 
616 	spin_lock_bh(&adapter->mac_vlan_list_lock);
617 	list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
618 		if (f->remove && ether_addr_equal(f->macaddr, netdev->dev_addr))
619 			f->remove = false;
620 
621 		if (f->is_new_mac) {
622 			list_del(&f->list);
623 			kfree(f);
624 		}
625 	}
626 	spin_unlock_bh(&adapter->mac_vlan_list_lock);
627 }
628 
629 /**
630  * iavf_vlan_add_reject
631  * @adapter: adapter structure
632  *
633  * Remove VLAN filters from list based on PF response.
634  **/
iavf_vlan_add_reject(struct iavf_adapter * adapter)635 static void iavf_vlan_add_reject(struct iavf_adapter *adapter)
636 {
637 	struct iavf_vlan_filter *f, *ftmp;
638 
639 	spin_lock_bh(&adapter->mac_vlan_list_lock);
640 	list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
641 		if (f->is_new_vlan) {
642 			if (f->vlan.tpid == ETH_P_8021Q)
643 				clear_bit(f->vlan.vid,
644 					  adapter->vsi.active_cvlans);
645 			else
646 				clear_bit(f->vlan.vid,
647 					  adapter->vsi.active_svlans);
648 
649 			list_del(&f->list);
650 			kfree(f);
651 		}
652 	}
653 	spin_unlock_bh(&adapter->mac_vlan_list_lock);
654 }
655 
656 /**
657  * iavf_add_vlans
658  * @adapter: adapter structure
659  *
660  * Request that the PF add one or more VLAN filters to our VSI.
661  **/
iavf_add_vlans(struct iavf_adapter * adapter)662 void iavf_add_vlans(struct iavf_adapter *adapter)
663 {
664 	int len, i = 0, count = 0;
665 	struct iavf_vlan_filter *f;
666 	bool more = false;
667 
668 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
669 		/* bail because we already have a command pending */
670 		dev_err(&adapter->pdev->dev, "Cannot add VLANs, command %d pending\n",
671 			adapter->current_op);
672 		return;
673 	}
674 
675 	spin_lock_bh(&adapter->mac_vlan_list_lock);
676 
677 	list_for_each_entry(f, &adapter->vlan_filter_list, list) {
678 		if (f->add)
679 			count++;
680 	}
681 	if (!count || !VLAN_FILTERING_ALLOWED(adapter)) {
682 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
683 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
684 		return;
685 	}
686 
687 	if (VLAN_ALLOWED(adapter)) {
688 		struct virtchnl_vlan_filter_list *vvfl;
689 
690 		adapter->current_op = VIRTCHNL_OP_ADD_VLAN;
691 
692 		len = sizeof(*vvfl) + (count * sizeof(u16));
693 		if (len > IAVF_MAX_AQ_BUF_SIZE) {
694 			dev_warn(&adapter->pdev->dev, "Too many add VLAN changes in one request\n");
695 			count = (IAVF_MAX_AQ_BUF_SIZE - sizeof(*vvfl)) /
696 				sizeof(u16);
697 			len = sizeof(*vvfl) + (count * sizeof(u16));
698 			more = true;
699 		}
700 		vvfl = kzalloc(len, GFP_ATOMIC);
701 		if (!vvfl) {
702 			spin_unlock_bh(&adapter->mac_vlan_list_lock);
703 			return;
704 		}
705 
706 		vvfl->vsi_id = adapter->vsi_res->vsi_id;
707 		vvfl->num_elements = count;
708 		list_for_each_entry(f, &adapter->vlan_filter_list, list) {
709 			if (f->add) {
710 				vvfl->vlan_id[i] = f->vlan.vid;
711 				i++;
712 				f->add = false;
713 				f->is_new_vlan = true;
714 				if (i == count)
715 					break;
716 			}
717 		}
718 		if (!more)
719 			adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
720 
721 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
722 
723 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_VLAN, (u8 *)vvfl, len);
724 		kfree(vvfl);
725 	} else {
726 		u16 max_vlans = adapter->vlan_v2_caps.filtering.max_filters;
727 		u16 current_vlans = iavf_get_num_vlans_added(adapter);
728 		struct virtchnl_vlan_filter_list_v2 *vvfl_v2;
729 
730 		adapter->current_op = VIRTCHNL_OP_ADD_VLAN_V2;
731 
732 		if ((count + current_vlans) > max_vlans &&
733 		    current_vlans < max_vlans) {
734 			count = max_vlans - iavf_get_num_vlans_added(adapter);
735 			more = true;
736 		}
737 
738 		len = sizeof(*vvfl_v2) + ((count - 1) *
739 					  sizeof(struct virtchnl_vlan_filter));
740 		if (len > IAVF_MAX_AQ_BUF_SIZE) {
741 			dev_warn(&adapter->pdev->dev, "Too many add VLAN changes in one request\n");
742 			count = (IAVF_MAX_AQ_BUF_SIZE - sizeof(*vvfl_v2)) /
743 				sizeof(struct virtchnl_vlan_filter);
744 			len = sizeof(*vvfl_v2) +
745 				((count - 1) *
746 				 sizeof(struct virtchnl_vlan_filter));
747 			more = true;
748 		}
749 
750 		vvfl_v2 = kzalloc(len, GFP_ATOMIC);
751 		if (!vvfl_v2) {
752 			spin_unlock_bh(&adapter->mac_vlan_list_lock);
753 			return;
754 		}
755 
756 		vvfl_v2->vport_id = adapter->vsi_res->vsi_id;
757 		vvfl_v2->num_elements = count;
758 		list_for_each_entry(f, &adapter->vlan_filter_list, list) {
759 			if (f->add) {
760 				struct virtchnl_vlan_supported_caps *filtering_support =
761 					&adapter->vlan_v2_caps.filtering.filtering_support;
762 				struct virtchnl_vlan *vlan;
763 
764 				if (i == count)
765 					break;
766 
767 				/* give priority over outer if it's enabled */
768 				if (filtering_support->outer)
769 					vlan = &vvfl_v2->filters[i].outer;
770 				else
771 					vlan = &vvfl_v2->filters[i].inner;
772 
773 				vlan->tci = f->vlan.vid;
774 				vlan->tpid = f->vlan.tpid;
775 
776 				i++;
777 				f->add = false;
778 				f->is_new_vlan = true;
779 			}
780 		}
781 
782 		if (!more)
783 			adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
784 
785 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
786 
787 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_VLAN_V2,
788 				 (u8 *)vvfl_v2, len);
789 		kfree(vvfl_v2);
790 	}
791 }
792 
793 /**
794  * iavf_del_vlans
795  * @adapter: adapter structure
796  *
797  * Request that the PF remove one or more VLAN filters from our VSI.
798  **/
iavf_del_vlans(struct iavf_adapter * adapter)799 void iavf_del_vlans(struct iavf_adapter *adapter)
800 {
801 	struct iavf_vlan_filter *f, *ftmp;
802 	int len, i = 0, count = 0;
803 	bool more = false;
804 
805 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
806 		/* bail because we already have a command pending */
807 		dev_err(&adapter->pdev->dev, "Cannot remove VLANs, command %d pending\n",
808 			adapter->current_op);
809 		return;
810 	}
811 
812 	spin_lock_bh(&adapter->mac_vlan_list_lock);
813 
814 	list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
815 		/* since VLAN capabilities are not allowed, we dont want to send
816 		 * a VLAN delete request because it will most likely fail and
817 		 * create unnecessary errors/noise, so just free the VLAN
818 		 * filters marked for removal to enable bailing out before
819 		 * sending a virtchnl message
820 		 */
821 		if (f->remove && !VLAN_FILTERING_ALLOWED(adapter)) {
822 			list_del(&f->list);
823 			kfree(f);
824 		} else if (f->remove) {
825 			count++;
826 		}
827 	}
828 	if (!count || !VLAN_FILTERING_ALLOWED(adapter)) {
829 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
830 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
831 		return;
832 	}
833 
834 	if (VLAN_ALLOWED(adapter)) {
835 		struct virtchnl_vlan_filter_list *vvfl;
836 
837 		adapter->current_op = VIRTCHNL_OP_DEL_VLAN;
838 
839 		len = sizeof(*vvfl) + (count * sizeof(u16));
840 		if (len > IAVF_MAX_AQ_BUF_SIZE) {
841 			dev_warn(&adapter->pdev->dev, "Too many delete VLAN changes in one request\n");
842 			count = (IAVF_MAX_AQ_BUF_SIZE - sizeof(*vvfl)) /
843 				sizeof(u16);
844 			len = sizeof(*vvfl) + (count * sizeof(u16));
845 			more = true;
846 		}
847 		vvfl = kzalloc(len, GFP_ATOMIC);
848 		if (!vvfl) {
849 			spin_unlock_bh(&adapter->mac_vlan_list_lock);
850 			return;
851 		}
852 
853 		vvfl->vsi_id = adapter->vsi_res->vsi_id;
854 		vvfl->num_elements = count;
855 		list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
856 			if (f->remove) {
857 				vvfl->vlan_id[i] = f->vlan.vid;
858 				i++;
859 				list_del(&f->list);
860 				kfree(f);
861 				if (i == count)
862 					break;
863 			}
864 		}
865 
866 		if (!more)
867 			adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
868 
869 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
870 
871 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_VLAN, (u8 *)vvfl, len);
872 		kfree(vvfl);
873 	} else {
874 		struct virtchnl_vlan_filter_list_v2 *vvfl_v2;
875 
876 		adapter->current_op = VIRTCHNL_OP_DEL_VLAN_V2;
877 
878 		len = sizeof(*vvfl_v2) +
879 			((count - 1) * sizeof(struct virtchnl_vlan_filter));
880 		if (len > IAVF_MAX_AQ_BUF_SIZE) {
881 			dev_warn(&adapter->pdev->dev, "Too many add VLAN changes in one request\n");
882 			count = (IAVF_MAX_AQ_BUF_SIZE -
883 				 sizeof(*vvfl_v2)) /
884 				sizeof(struct virtchnl_vlan_filter);
885 			len = sizeof(*vvfl_v2) +
886 				((count - 1) *
887 				 sizeof(struct virtchnl_vlan_filter));
888 			more = true;
889 		}
890 
891 		vvfl_v2 = kzalloc(len, GFP_ATOMIC);
892 		if (!vvfl_v2) {
893 			spin_unlock_bh(&adapter->mac_vlan_list_lock);
894 			return;
895 		}
896 
897 		vvfl_v2->vport_id = adapter->vsi_res->vsi_id;
898 		vvfl_v2->num_elements = count;
899 		list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
900 			if (f->remove) {
901 				struct virtchnl_vlan_supported_caps *filtering_support =
902 					&adapter->vlan_v2_caps.filtering.filtering_support;
903 				struct virtchnl_vlan *vlan;
904 
905 				/* give priority over outer if it's enabled */
906 				if (filtering_support->outer)
907 					vlan = &vvfl_v2->filters[i].outer;
908 				else
909 					vlan = &vvfl_v2->filters[i].inner;
910 
911 				vlan->tci = f->vlan.vid;
912 				vlan->tpid = f->vlan.tpid;
913 
914 				list_del(&f->list);
915 				kfree(f);
916 				i++;
917 				if (i == count)
918 					break;
919 			}
920 		}
921 
922 		if (!more)
923 			adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
924 
925 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
926 
927 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_VLAN_V2,
928 				 (u8 *)vvfl_v2, len);
929 		kfree(vvfl_v2);
930 	}
931 }
932 
933 /**
934  * iavf_set_promiscuous
935  * @adapter: adapter structure
936  * @flags: bitmask to control unicast/multicast promiscuous.
937  *
938  * Request that the PF enable promiscuous mode for our VSI.
939  **/
iavf_set_promiscuous(struct iavf_adapter * adapter,int flags)940 void iavf_set_promiscuous(struct iavf_adapter *adapter, int flags)
941 {
942 	struct virtchnl_promisc_info vpi;
943 	int promisc_all;
944 
945 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
946 		/* bail because we already have a command pending */
947 		dev_err(&adapter->pdev->dev, "Cannot set promiscuous mode, command %d pending\n",
948 			adapter->current_op);
949 		return;
950 	}
951 
952 	promisc_all = FLAG_VF_UNICAST_PROMISC |
953 		      FLAG_VF_MULTICAST_PROMISC;
954 	if ((flags & promisc_all) == promisc_all) {
955 		adapter->flags |= IAVF_FLAG_PROMISC_ON;
956 		adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_PROMISC;
957 		dev_info(&adapter->pdev->dev, "Entering promiscuous mode\n");
958 	}
959 
960 	if (flags & FLAG_VF_MULTICAST_PROMISC) {
961 		adapter->flags |= IAVF_FLAG_ALLMULTI_ON;
962 		adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_ALLMULTI;
963 		dev_info(&adapter->pdev->dev, "%s is entering multicast promiscuous mode\n",
964 			 adapter->netdev->name);
965 	}
966 
967 	if (!flags) {
968 		if (adapter->flags & IAVF_FLAG_PROMISC_ON) {
969 			adapter->flags &= ~IAVF_FLAG_PROMISC_ON;
970 			adapter->aq_required &= ~IAVF_FLAG_AQ_RELEASE_PROMISC;
971 			dev_info(&adapter->pdev->dev, "Leaving promiscuous mode\n");
972 		}
973 
974 		if (adapter->flags & IAVF_FLAG_ALLMULTI_ON) {
975 			adapter->flags &= ~IAVF_FLAG_ALLMULTI_ON;
976 			adapter->aq_required &= ~IAVF_FLAG_AQ_RELEASE_ALLMULTI;
977 			dev_info(&adapter->pdev->dev, "%s is leaving multicast promiscuous mode\n",
978 				 adapter->netdev->name);
979 		}
980 	}
981 
982 	adapter->current_op = VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE;
983 	vpi.vsi_id = adapter->vsi_res->vsi_id;
984 	vpi.flags = flags;
985 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
986 			 (u8 *)&vpi, sizeof(vpi));
987 }
988 
989 /**
990  * iavf_request_stats
991  * @adapter: adapter structure
992  *
993  * Request VSI statistics from PF.
994  **/
iavf_request_stats(struct iavf_adapter * adapter)995 void iavf_request_stats(struct iavf_adapter *adapter)
996 {
997 	struct virtchnl_queue_select vqs;
998 
999 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1000 		/* no error message, this isn't crucial */
1001 		return;
1002 	}
1003 
1004 	adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_STATS;
1005 	adapter->current_op = VIRTCHNL_OP_GET_STATS;
1006 	vqs.vsi_id = adapter->vsi_res->vsi_id;
1007 	/* queue maps are ignored for this message - only the vsi is used */
1008 	if (iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_STATS, (u8 *)&vqs,
1009 			     sizeof(vqs)))
1010 		/* if the request failed, don't lock out others */
1011 		adapter->current_op = VIRTCHNL_OP_UNKNOWN;
1012 }
1013 
1014 /**
1015  * iavf_get_hena
1016  * @adapter: adapter structure
1017  *
1018  * Request hash enable capabilities from PF
1019  **/
iavf_get_hena(struct iavf_adapter * adapter)1020 void iavf_get_hena(struct iavf_adapter *adapter)
1021 {
1022 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1023 		/* bail because we already have a command pending */
1024 		dev_err(&adapter->pdev->dev, "Cannot get RSS hash capabilities, command %d pending\n",
1025 			adapter->current_op);
1026 		return;
1027 	}
1028 	adapter->current_op = VIRTCHNL_OP_GET_RSS_HENA_CAPS;
1029 	adapter->aq_required &= ~IAVF_FLAG_AQ_GET_HENA;
1030 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_RSS_HENA_CAPS, NULL, 0);
1031 }
1032 
1033 /**
1034  * iavf_set_hena
1035  * @adapter: adapter structure
1036  *
1037  * Request the PF to set our RSS hash capabilities
1038  **/
iavf_set_hena(struct iavf_adapter * adapter)1039 void iavf_set_hena(struct iavf_adapter *adapter)
1040 {
1041 	struct virtchnl_rss_hena vrh;
1042 
1043 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1044 		/* bail because we already have a command pending */
1045 		dev_err(&adapter->pdev->dev, "Cannot set RSS hash enable, command %d pending\n",
1046 			adapter->current_op);
1047 		return;
1048 	}
1049 	vrh.hena = adapter->hena;
1050 	adapter->current_op = VIRTCHNL_OP_SET_RSS_HENA;
1051 	adapter->aq_required &= ~IAVF_FLAG_AQ_SET_HENA;
1052 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_SET_RSS_HENA, (u8 *)&vrh,
1053 			 sizeof(vrh));
1054 }
1055 
1056 /**
1057  * iavf_set_rss_key
1058  * @adapter: adapter structure
1059  *
1060  * Request the PF to set our RSS hash key
1061  **/
iavf_set_rss_key(struct iavf_adapter * adapter)1062 void iavf_set_rss_key(struct iavf_adapter *adapter)
1063 {
1064 	struct virtchnl_rss_key *vrk;
1065 	int len;
1066 
1067 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1068 		/* bail because we already have a command pending */
1069 		dev_err(&adapter->pdev->dev, "Cannot set RSS key, command %d pending\n",
1070 			adapter->current_op);
1071 		return;
1072 	}
1073 	len = sizeof(struct virtchnl_rss_key) +
1074 	      (adapter->rss_key_size * sizeof(u8)) - 1;
1075 	vrk = kzalloc(len, GFP_KERNEL);
1076 	if (!vrk)
1077 		return;
1078 	vrk->vsi_id = adapter->vsi.id;
1079 	vrk->key_len = adapter->rss_key_size;
1080 	memcpy(vrk->key, adapter->rss_key, adapter->rss_key_size);
1081 
1082 	adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_KEY;
1083 	adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_KEY;
1084 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_KEY, (u8 *)vrk, len);
1085 	kfree(vrk);
1086 }
1087 
1088 /**
1089  * iavf_set_rss_lut
1090  * @adapter: adapter structure
1091  *
1092  * Request the PF to set our RSS lookup table
1093  **/
iavf_set_rss_lut(struct iavf_adapter * adapter)1094 void iavf_set_rss_lut(struct iavf_adapter *adapter)
1095 {
1096 	struct virtchnl_rss_lut *vrl;
1097 	int len;
1098 
1099 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1100 		/* bail because we already have a command pending */
1101 		dev_err(&adapter->pdev->dev, "Cannot set RSS LUT, command %d pending\n",
1102 			adapter->current_op);
1103 		return;
1104 	}
1105 	len = sizeof(struct virtchnl_rss_lut) +
1106 	      (adapter->rss_lut_size * sizeof(u8)) - 1;
1107 	vrl = kzalloc(len, GFP_KERNEL);
1108 	if (!vrl)
1109 		return;
1110 	vrl->vsi_id = adapter->vsi.id;
1111 	vrl->lut_entries = adapter->rss_lut_size;
1112 	memcpy(vrl->lut, adapter->rss_lut, adapter->rss_lut_size);
1113 	adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_LUT;
1114 	adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_LUT;
1115 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_LUT, (u8 *)vrl, len);
1116 	kfree(vrl);
1117 }
1118 
1119 /**
1120  * iavf_enable_vlan_stripping
1121  * @adapter: adapter structure
1122  *
1123  * Request VLAN header stripping to be enabled
1124  **/
iavf_enable_vlan_stripping(struct iavf_adapter * adapter)1125 void iavf_enable_vlan_stripping(struct iavf_adapter *adapter)
1126 {
1127 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1128 		/* bail because we already have a command pending */
1129 		dev_err(&adapter->pdev->dev, "Cannot enable stripping, command %d pending\n",
1130 			adapter->current_op);
1131 		return;
1132 	}
1133 	adapter->current_op = VIRTCHNL_OP_ENABLE_VLAN_STRIPPING;
1134 	adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_VLAN_STRIPPING;
1135 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING, NULL, 0);
1136 }
1137 
1138 /**
1139  * iavf_disable_vlan_stripping
1140  * @adapter: adapter structure
1141  *
1142  * Request VLAN header stripping to be disabled
1143  **/
iavf_disable_vlan_stripping(struct iavf_adapter * adapter)1144 void iavf_disable_vlan_stripping(struct iavf_adapter *adapter)
1145 {
1146 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1147 		/* bail because we already have a command pending */
1148 		dev_err(&adapter->pdev->dev, "Cannot disable stripping, command %d pending\n",
1149 			adapter->current_op);
1150 		return;
1151 	}
1152 	adapter->current_op = VIRTCHNL_OP_DISABLE_VLAN_STRIPPING;
1153 	adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_VLAN_STRIPPING;
1154 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING, NULL, 0);
1155 }
1156 
1157 /**
1158  * iavf_tpid_to_vc_ethertype - transform from VLAN TPID to virtchnl ethertype
1159  * @tpid: VLAN TPID (i.e. 0x8100, 0x88a8, etc.)
1160  */
iavf_tpid_to_vc_ethertype(u16 tpid)1161 static u32 iavf_tpid_to_vc_ethertype(u16 tpid)
1162 {
1163 	switch (tpid) {
1164 	case ETH_P_8021Q:
1165 		return VIRTCHNL_VLAN_ETHERTYPE_8100;
1166 	case ETH_P_8021AD:
1167 		return VIRTCHNL_VLAN_ETHERTYPE_88A8;
1168 	}
1169 
1170 	return 0;
1171 }
1172 
1173 /**
1174  * iavf_set_vc_offload_ethertype - set virtchnl ethertype for offload message
1175  * @adapter: adapter structure
1176  * @msg: message structure used for updating offloads over virtchnl to update
1177  * @tpid: VLAN TPID (i.e. 0x8100, 0x88a8, etc.)
1178  * @offload_op: opcode used to determine which support structure to check
1179  */
1180 static int
iavf_set_vc_offload_ethertype(struct iavf_adapter * adapter,struct virtchnl_vlan_setting * msg,u16 tpid,enum virtchnl_ops offload_op)1181 iavf_set_vc_offload_ethertype(struct iavf_adapter *adapter,
1182 			      struct virtchnl_vlan_setting *msg, u16 tpid,
1183 			      enum virtchnl_ops offload_op)
1184 {
1185 	struct virtchnl_vlan_supported_caps *offload_support;
1186 	u16 vc_ethertype = iavf_tpid_to_vc_ethertype(tpid);
1187 
1188 	/* reference the correct offload support structure */
1189 	switch (offload_op) {
1190 	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2:
1191 	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2:
1192 		offload_support =
1193 			&adapter->vlan_v2_caps.offloads.stripping_support;
1194 		break;
1195 	case VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2:
1196 	case VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2:
1197 		offload_support =
1198 			&adapter->vlan_v2_caps.offloads.insertion_support;
1199 		break;
1200 	default:
1201 		dev_err(&adapter->pdev->dev, "Invalid opcode %d for setting virtchnl ethertype to enable/disable VLAN offloads\n",
1202 			offload_op);
1203 		return -EINVAL;
1204 	}
1205 
1206 	/* make sure ethertype is supported */
1207 	if (offload_support->outer & vc_ethertype &&
1208 	    offload_support->outer & VIRTCHNL_VLAN_TOGGLE) {
1209 		msg->outer_ethertype_setting = vc_ethertype;
1210 	} else if (offload_support->inner & vc_ethertype &&
1211 		   offload_support->inner & VIRTCHNL_VLAN_TOGGLE) {
1212 		msg->inner_ethertype_setting = vc_ethertype;
1213 	} else {
1214 		dev_dbg(&adapter->pdev->dev, "opcode %d unsupported for VLAN TPID 0x%04x\n",
1215 			offload_op, tpid);
1216 		return -EINVAL;
1217 	}
1218 
1219 	return 0;
1220 }
1221 
1222 /**
1223  * iavf_clear_offload_v2_aq_required - clear AQ required bit for offload request
1224  * @adapter: adapter structure
1225  * @tpid: VLAN TPID
1226  * @offload_op: opcode used to determine which AQ required bit to clear
1227  */
1228 static void
iavf_clear_offload_v2_aq_required(struct iavf_adapter * adapter,u16 tpid,enum virtchnl_ops offload_op)1229 iavf_clear_offload_v2_aq_required(struct iavf_adapter *adapter, u16 tpid,
1230 				  enum virtchnl_ops offload_op)
1231 {
1232 	switch (offload_op) {
1233 	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2:
1234 		if (tpid == ETH_P_8021Q)
1235 			adapter->aq_required &=
1236 				~IAVF_FLAG_AQ_ENABLE_CTAG_VLAN_STRIPPING;
1237 		else if (tpid == ETH_P_8021AD)
1238 			adapter->aq_required &=
1239 				~IAVF_FLAG_AQ_ENABLE_STAG_VLAN_STRIPPING;
1240 		break;
1241 	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2:
1242 		if (tpid == ETH_P_8021Q)
1243 			adapter->aq_required &=
1244 				~IAVF_FLAG_AQ_DISABLE_CTAG_VLAN_STRIPPING;
1245 		else if (tpid == ETH_P_8021AD)
1246 			adapter->aq_required &=
1247 				~IAVF_FLAG_AQ_DISABLE_STAG_VLAN_STRIPPING;
1248 		break;
1249 	case VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2:
1250 		if (tpid == ETH_P_8021Q)
1251 			adapter->aq_required &=
1252 				~IAVF_FLAG_AQ_ENABLE_CTAG_VLAN_INSERTION;
1253 		else if (tpid == ETH_P_8021AD)
1254 			adapter->aq_required &=
1255 				~IAVF_FLAG_AQ_ENABLE_STAG_VLAN_INSERTION;
1256 		break;
1257 	case VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2:
1258 		if (tpid == ETH_P_8021Q)
1259 			adapter->aq_required &=
1260 				~IAVF_FLAG_AQ_DISABLE_CTAG_VLAN_INSERTION;
1261 		else if (tpid == ETH_P_8021AD)
1262 			adapter->aq_required &=
1263 				~IAVF_FLAG_AQ_DISABLE_STAG_VLAN_INSERTION;
1264 		break;
1265 	default:
1266 		dev_err(&adapter->pdev->dev, "Unsupported opcode %d specified for clearing aq_required bits for VIRTCHNL_VF_OFFLOAD_VLAN_V2 offload request\n",
1267 			offload_op);
1268 	}
1269 }
1270 
1271 /**
1272  * iavf_send_vlan_offload_v2 - send offload enable/disable over virtchnl
1273  * @adapter: adapter structure
1274  * @tpid: VLAN TPID used for the command (i.e. 0x8100 or 0x88a8)
1275  * @offload_op: offload_op used to make the request over virtchnl
1276  */
1277 static void
iavf_send_vlan_offload_v2(struct iavf_adapter * adapter,u16 tpid,enum virtchnl_ops offload_op)1278 iavf_send_vlan_offload_v2(struct iavf_adapter *adapter, u16 tpid,
1279 			  enum virtchnl_ops offload_op)
1280 {
1281 	struct virtchnl_vlan_setting *msg;
1282 	int len = sizeof(*msg);
1283 
1284 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1285 		/* bail because we already have a command pending */
1286 		dev_err(&adapter->pdev->dev, "Cannot send %d, command %d pending\n",
1287 			offload_op, adapter->current_op);
1288 		return;
1289 	}
1290 
1291 	adapter->current_op = offload_op;
1292 
1293 	msg = kzalloc(len, GFP_KERNEL);
1294 	if (!msg)
1295 		return;
1296 
1297 	msg->vport_id = adapter->vsi_res->vsi_id;
1298 
1299 	/* always clear to prevent unsupported and endless requests */
1300 	iavf_clear_offload_v2_aq_required(adapter, tpid, offload_op);
1301 
1302 	/* only send valid offload requests */
1303 	if (!iavf_set_vc_offload_ethertype(adapter, msg, tpid, offload_op))
1304 		iavf_send_pf_msg(adapter, offload_op, (u8 *)msg, len);
1305 	else
1306 		adapter->current_op = VIRTCHNL_OP_UNKNOWN;
1307 
1308 	kfree(msg);
1309 }
1310 
1311 /**
1312  * iavf_enable_vlan_stripping_v2 - enable VLAN stripping
1313  * @adapter: adapter structure
1314  * @tpid: VLAN TPID used to enable VLAN stripping
1315  */
iavf_enable_vlan_stripping_v2(struct iavf_adapter * adapter,u16 tpid)1316 void iavf_enable_vlan_stripping_v2(struct iavf_adapter *adapter, u16 tpid)
1317 {
1318 	iavf_send_vlan_offload_v2(adapter, tpid,
1319 				  VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2);
1320 }
1321 
1322 /**
1323  * iavf_disable_vlan_stripping_v2 - disable VLAN stripping
1324  * @adapter: adapter structure
1325  * @tpid: VLAN TPID used to disable VLAN stripping
1326  */
iavf_disable_vlan_stripping_v2(struct iavf_adapter * adapter,u16 tpid)1327 void iavf_disable_vlan_stripping_v2(struct iavf_adapter *adapter, u16 tpid)
1328 {
1329 	iavf_send_vlan_offload_v2(adapter, tpid,
1330 				  VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2);
1331 }
1332 
1333 /**
1334  * iavf_enable_vlan_insertion_v2 - enable VLAN insertion
1335  * @adapter: adapter structure
1336  * @tpid: VLAN TPID used to enable VLAN insertion
1337  */
iavf_enable_vlan_insertion_v2(struct iavf_adapter * adapter,u16 tpid)1338 void iavf_enable_vlan_insertion_v2(struct iavf_adapter *adapter, u16 tpid)
1339 {
1340 	iavf_send_vlan_offload_v2(adapter, tpid,
1341 				  VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2);
1342 }
1343 
1344 /**
1345  * iavf_disable_vlan_insertion_v2 - disable VLAN insertion
1346  * @adapter: adapter structure
1347  * @tpid: VLAN TPID used to disable VLAN insertion
1348  */
iavf_disable_vlan_insertion_v2(struct iavf_adapter * adapter,u16 tpid)1349 void iavf_disable_vlan_insertion_v2(struct iavf_adapter *adapter, u16 tpid)
1350 {
1351 	iavf_send_vlan_offload_v2(adapter, tpid,
1352 				  VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2);
1353 }
1354 
1355 #define IAVF_MAX_SPEED_STRLEN	13
1356 
1357 /**
1358  * iavf_print_link_message - print link up or down
1359  * @adapter: adapter structure
1360  *
1361  * Log a message telling the world of our wonderous link status
1362  */
iavf_print_link_message(struct iavf_adapter * adapter)1363 static void iavf_print_link_message(struct iavf_adapter *adapter)
1364 {
1365 	struct net_device *netdev = adapter->netdev;
1366 	int link_speed_mbps;
1367 	char *speed;
1368 
1369 	if (!adapter->link_up) {
1370 		netdev_info(netdev, "NIC Link is Down\n");
1371 		return;
1372 	}
1373 
1374 	speed = kzalloc(IAVF_MAX_SPEED_STRLEN, GFP_KERNEL);
1375 	if (!speed)
1376 		return;
1377 
1378 	if (ADV_LINK_SUPPORT(adapter)) {
1379 		link_speed_mbps = adapter->link_speed_mbps;
1380 		goto print_link_msg;
1381 	}
1382 
1383 	switch (adapter->link_speed) {
1384 	case VIRTCHNL_LINK_SPEED_40GB:
1385 		link_speed_mbps = SPEED_40000;
1386 		break;
1387 	case VIRTCHNL_LINK_SPEED_25GB:
1388 		link_speed_mbps = SPEED_25000;
1389 		break;
1390 	case VIRTCHNL_LINK_SPEED_20GB:
1391 		link_speed_mbps = SPEED_20000;
1392 		break;
1393 	case VIRTCHNL_LINK_SPEED_10GB:
1394 		link_speed_mbps = SPEED_10000;
1395 		break;
1396 	case VIRTCHNL_LINK_SPEED_5GB:
1397 		link_speed_mbps = SPEED_5000;
1398 		break;
1399 	case VIRTCHNL_LINK_SPEED_2_5GB:
1400 		link_speed_mbps = SPEED_2500;
1401 		break;
1402 	case VIRTCHNL_LINK_SPEED_1GB:
1403 		link_speed_mbps = SPEED_1000;
1404 		break;
1405 	case VIRTCHNL_LINK_SPEED_100MB:
1406 		link_speed_mbps = SPEED_100;
1407 		break;
1408 	default:
1409 		link_speed_mbps = SPEED_UNKNOWN;
1410 		break;
1411 	}
1412 
1413 print_link_msg:
1414 	if (link_speed_mbps > SPEED_1000) {
1415 		if (link_speed_mbps == SPEED_2500)
1416 			snprintf(speed, IAVF_MAX_SPEED_STRLEN, "2.5 Gbps");
1417 		else
1418 			/* convert to Gbps inline */
1419 			snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%d %s",
1420 				 link_speed_mbps / 1000, "Gbps");
1421 	} else if (link_speed_mbps == SPEED_UNKNOWN) {
1422 		snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%s", "Unknown Mbps");
1423 	} else {
1424 		snprintf(speed, IAVF_MAX_SPEED_STRLEN, "%d %s",
1425 			 link_speed_mbps, "Mbps");
1426 	}
1427 
1428 	netdev_info(netdev, "NIC Link is Up Speed is %s Full Duplex\n", speed);
1429 	kfree(speed);
1430 }
1431 
1432 /**
1433  * iavf_get_vpe_link_status
1434  * @adapter: adapter structure
1435  * @vpe: virtchnl_pf_event structure
1436  *
1437  * Helper function for determining the link status
1438  **/
1439 static bool
iavf_get_vpe_link_status(struct iavf_adapter * adapter,struct virtchnl_pf_event * vpe)1440 iavf_get_vpe_link_status(struct iavf_adapter *adapter,
1441 			 struct virtchnl_pf_event *vpe)
1442 {
1443 	if (ADV_LINK_SUPPORT(adapter))
1444 		return vpe->event_data.link_event_adv.link_status;
1445 	else
1446 		return vpe->event_data.link_event.link_status;
1447 }
1448 
1449 /**
1450  * iavf_set_adapter_link_speed_from_vpe
1451  * @adapter: adapter structure for which we are setting the link speed
1452  * @vpe: virtchnl_pf_event structure that contains the link speed we are setting
1453  *
1454  * Helper function for setting iavf_adapter link speed
1455  **/
1456 static void
iavf_set_adapter_link_speed_from_vpe(struct iavf_adapter * adapter,struct virtchnl_pf_event * vpe)1457 iavf_set_adapter_link_speed_from_vpe(struct iavf_adapter *adapter,
1458 				     struct virtchnl_pf_event *vpe)
1459 {
1460 	if (ADV_LINK_SUPPORT(adapter))
1461 		adapter->link_speed_mbps =
1462 			vpe->event_data.link_event_adv.link_speed;
1463 	else
1464 		adapter->link_speed = vpe->event_data.link_event.link_speed;
1465 }
1466 
1467 /**
1468  * iavf_enable_channels
1469  * @adapter: adapter structure
1470  *
1471  * Request that the PF enable channels as specified by
1472  * the user via tc tool.
1473  **/
iavf_enable_channels(struct iavf_adapter * adapter)1474 void iavf_enable_channels(struct iavf_adapter *adapter)
1475 {
1476 	struct virtchnl_tc_info *vti = NULL;
1477 	size_t len;
1478 	int i;
1479 
1480 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1481 		/* bail because we already have a command pending */
1482 		dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
1483 			adapter->current_op);
1484 		return;
1485 	}
1486 
1487 	len = struct_size(vti, list, adapter->num_tc - 1);
1488 	vti = kzalloc(len, GFP_KERNEL);
1489 	if (!vti)
1490 		return;
1491 	vti->num_tc = adapter->num_tc;
1492 	for (i = 0; i < vti->num_tc; i++) {
1493 		vti->list[i].count = adapter->ch_config.ch_info[i].count;
1494 		vti->list[i].offset = adapter->ch_config.ch_info[i].offset;
1495 		vti->list[i].pad = 0;
1496 		vti->list[i].max_tx_rate =
1497 				adapter->ch_config.ch_info[i].max_tx_rate;
1498 	}
1499 
1500 	adapter->ch_config.state = __IAVF_TC_RUNNING;
1501 	adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
1502 	adapter->current_op = VIRTCHNL_OP_ENABLE_CHANNELS;
1503 	adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_CHANNELS;
1504 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_CHANNELS, (u8 *)vti, len);
1505 	kfree(vti);
1506 }
1507 
1508 /**
1509  * iavf_disable_channels
1510  * @adapter: adapter structure
1511  *
1512  * Request that the PF disable channels that are configured
1513  **/
iavf_disable_channels(struct iavf_adapter * adapter)1514 void iavf_disable_channels(struct iavf_adapter *adapter)
1515 {
1516 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1517 		/* bail because we already have a command pending */
1518 		dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
1519 			adapter->current_op);
1520 		return;
1521 	}
1522 
1523 	adapter->ch_config.state = __IAVF_TC_INVALID;
1524 	adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
1525 	adapter->current_op = VIRTCHNL_OP_DISABLE_CHANNELS;
1526 	adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_CHANNELS;
1527 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_CHANNELS, NULL, 0);
1528 }
1529 
1530 /**
1531  * iavf_print_cloud_filter
1532  * @adapter: adapter structure
1533  * @f: cloud filter to print
1534  *
1535  * Print the cloud filter
1536  **/
iavf_print_cloud_filter(struct iavf_adapter * adapter,struct virtchnl_filter * f)1537 static void iavf_print_cloud_filter(struct iavf_adapter *adapter,
1538 				    struct virtchnl_filter *f)
1539 {
1540 	switch (f->flow_type) {
1541 	case VIRTCHNL_TCP_V4_FLOW:
1542 		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",
1543 			 &f->data.tcp_spec.dst_mac,
1544 			 &f->data.tcp_spec.src_mac,
1545 			 ntohs(f->data.tcp_spec.vlan_id),
1546 			 &f->data.tcp_spec.dst_ip[0],
1547 			 &f->data.tcp_spec.src_ip[0],
1548 			 ntohs(f->data.tcp_spec.dst_port),
1549 			 ntohs(f->data.tcp_spec.src_port));
1550 		break;
1551 	case VIRTCHNL_TCP_V6_FLOW:
1552 		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",
1553 			 &f->data.tcp_spec.dst_mac,
1554 			 &f->data.tcp_spec.src_mac,
1555 			 ntohs(f->data.tcp_spec.vlan_id),
1556 			 &f->data.tcp_spec.dst_ip,
1557 			 &f->data.tcp_spec.src_ip,
1558 			 ntohs(f->data.tcp_spec.dst_port),
1559 			 ntohs(f->data.tcp_spec.src_port));
1560 		break;
1561 	}
1562 }
1563 
1564 /**
1565  * iavf_add_cloud_filter
1566  * @adapter: adapter structure
1567  *
1568  * Request that the PF add cloud filters as specified
1569  * by the user via tc tool.
1570  **/
iavf_add_cloud_filter(struct iavf_adapter * adapter)1571 void iavf_add_cloud_filter(struct iavf_adapter *adapter)
1572 {
1573 	struct iavf_cloud_filter *cf;
1574 	struct virtchnl_filter *f;
1575 	int len = 0, count = 0;
1576 
1577 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1578 		/* bail because we already have a command pending */
1579 		dev_err(&adapter->pdev->dev, "Cannot add cloud filter, command %d pending\n",
1580 			adapter->current_op);
1581 		return;
1582 	}
1583 	list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1584 		if (cf->add) {
1585 			count++;
1586 			break;
1587 		}
1588 	}
1589 	if (!count) {
1590 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_CLOUD_FILTER;
1591 		return;
1592 	}
1593 	adapter->current_op = VIRTCHNL_OP_ADD_CLOUD_FILTER;
1594 
1595 	len = sizeof(struct virtchnl_filter);
1596 	f = kzalloc(len, GFP_KERNEL);
1597 	if (!f)
1598 		return;
1599 
1600 	list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1601 		if (cf->add) {
1602 			memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
1603 			cf->add = false;
1604 			cf->state = __IAVF_CF_ADD_PENDING;
1605 			iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_CLOUD_FILTER,
1606 					 (u8 *)f, len);
1607 		}
1608 	}
1609 	kfree(f);
1610 }
1611 
1612 /**
1613  * iavf_del_cloud_filter
1614  * @adapter: adapter structure
1615  *
1616  * Request that the PF delete cloud filters as specified
1617  * by the user via tc tool.
1618  **/
iavf_del_cloud_filter(struct iavf_adapter * adapter)1619 void iavf_del_cloud_filter(struct iavf_adapter *adapter)
1620 {
1621 	struct iavf_cloud_filter *cf, *cftmp;
1622 	struct virtchnl_filter *f;
1623 	int len = 0, count = 0;
1624 
1625 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1626 		/* bail because we already have a command pending */
1627 		dev_err(&adapter->pdev->dev, "Cannot remove cloud filter, command %d pending\n",
1628 			adapter->current_op);
1629 		return;
1630 	}
1631 	list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
1632 		if (cf->del) {
1633 			count++;
1634 			break;
1635 		}
1636 	}
1637 	if (!count) {
1638 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_CLOUD_FILTER;
1639 		return;
1640 	}
1641 	adapter->current_op = VIRTCHNL_OP_DEL_CLOUD_FILTER;
1642 
1643 	len = sizeof(struct virtchnl_filter);
1644 	f = kzalloc(len, GFP_KERNEL);
1645 	if (!f)
1646 		return;
1647 
1648 	list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list, list) {
1649 		if (cf->del) {
1650 			memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
1651 			cf->del = false;
1652 			cf->state = __IAVF_CF_DEL_PENDING;
1653 			iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_CLOUD_FILTER,
1654 					 (u8 *)f, len);
1655 		}
1656 	}
1657 	kfree(f);
1658 }
1659 
1660 /**
1661  * iavf_add_fdir_filter
1662  * @adapter: the VF adapter structure
1663  *
1664  * Request that the PF add Flow Director filters as specified
1665  * by the user via ethtool.
1666  **/
iavf_add_fdir_filter(struct iavf_adapter * adapter)1667 void iavf_add_fdir_filter(struct iavf_adapter *adapter)
1668 {
1669 	struct iavf_fdir_fltr *fdir;
1670 	struct virtchnl_fdir_add *f;
1671 	bool process_fltr = false;
1672 	int len;
1673 
1674 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1675 		/* bail because we already have a command pending */
1676 		dev_err(&adapter->pdev->dev, "Cannot add Flow Director filter, command %d pending\n",
1677 			adapter->current_op);
1678 		return;
1679 	}
1680 
1681 	len = sizeof(struct virtchnl_fdir_add);
1682 	f = kzalloc(len, GFP_KERNEL);
1683 	if (!f)
1684 		return;
1685 
1686 	spin_lock_bh(&adapter->fdir_fltr_lock);
1687 	list_for_each_entry(fdir, &adapter->fdir_list_head, list) {
1688 		if (fdir->state == IAVF_FDIR_FLTR_ADD_REQUEST) {
1689 			process_fltr = true;
1690 			fdir->state = IAVF_FDIR_FLTR_ADD_PENDING;
1691 			memcpy(f, &fdir->vc_add_msg, len);
1692 			break;
1693 		}
1694 	}
1695 	spin_unlock_bh(&adapter->fdir_fltr_lock);
1696 
1697 	if (!process_fltr) {
1698 		/* prevent iavf_add_fdir_filter() from being called when there
1699 		 * are no filters to add
1700 		 */
1701 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_FDIR_FILTER;
1702 		kfree(f);
1703 		return;
1704 	}
1705 	adapter->current_op = VIRTCHNL_OP_ADD_FDIR_FILTER;
1706 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_FDIR_FILTER, (u8 *)f, len);
1707 	kfree(f);
1708 }
1709 
1710 /**
1711  * iavf_del_fdir_filter
1712  * @adapter: the VF adapter structure
1713  *
1714  * Request that the PF delete Flow Director filters as specified
1715  * by the user via ethtool.
1716  **/
iavf_del_fdir_filter(struct iavf_adapter * adapter)1717 void iavf_del_fdir_filter(struct iavf_adapter *adapter)
1718 {
1719 	struct iavf_fdir_fltr *fdir;
1720 	struct virtchnl_fdir_del f;
1721 	bool process_fltr = false;
1722 	int len;
1723 
1724 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1725 		/* bail because we already have a command pending */
1726 		dev_err(&adapter->pdev->dev, "Cannot remove Flow Director filter, command %d pending\n",
1727 			adapter->current_op);
1728 		return;
1729 	}
1730 
1731 	len = sizeof(struct virtchnl_fdir_del);
1732 
1733 	spin_lock_bh(&adapter->fdir_fltr_lock);
1734 	list_for_each_entry(fdir, &adapter->fdir_list_head, list) {
1735 		if (fdir->state == IAVF_FDIR_FLTR_DEL_REQUEST) {
1736 			process_fltr = true;
1737 			memset(&f, 0, len);
1738 			f.vsi_id = fdir->vc_add_msg.vsi_id;
1739 			f.flow_id = fdir->flow_id;
1740 			fdir->state = IAVF_FDIR_FLTR_DEL_PENDING;
1741 			break;
1742 		}
1743 	}
1744 	spin_unlock_bh(&adapter->fdir_fltr_lock);
1745 
1746 	if (!process_fltr) {
1747 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_FDIR_FILTER;
1748 		return;
1749 	}
1750 
1751 	adapter->current_op = VIRTCHNL_OP_DEL_FDIR_FILTER;
1752 	iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_FDIR_FILTER, (u8 *)&f, len);
1753 }
1754 
1755 /**
1756  * iavf_add_adv_rss_cfg
1757  * @adapter: the VF adapter structure
1758  *
1759  * Request that the PF add RSS configuration as specified
1760  * by the user via ethtool.
1761  **/
iavf_add_adv_rss_cfg(struct iavf_adapter * adapter)1762 void iavf_add_adv_rss_cfg(struct iavf_adapter *adapter)
1763 {
1764 	struct virtchnl_rss_cfg *rss_cfg;
1765 	struct iavf_adv_rss *rss;
1766 	bool process_rss = false;
1767 	int len;
1768 
1769 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1770 		/* bail because we already have a command pending */
1771 		dev_err(&adapter->pdev->dev, "Cannot add RSS configuration, command %d pending\n",
1772 			adapter->current_op);
1773 		return;
1774 	}
1775 
1776 	len = sizeof(struct virtchnl_rss_cfg);
1777 	rss_cfg = kzalloc(len, GFP_KERNEL);
1778 	if (!rss_cfg)
1779 		return;
1780 
1781 	spin_lock_bh(&adapter->adv_rss_lock);
1782 	list_for_each_entry(rss, &adapter->adv_rss_list_head, list) {
1783 		if (rss->state == IAVF_ADV_RSS_ADD_REQUEST) {
1784 			process_rss = true;
1785 			rss->state = IAVF_ADV_RSS_ADD_PENDING;
1786 			memcpy(rss_cfg, &rss->cfg_msg, len);
1787 			iavf_print_adv_rss_cfg(adapter, rss,
1788 					       "Input set change for",
1789 					       "is pending");
1790 			break;
1791 		}
1792 	}
1793 	spin_unlock_bh(&adapter->adv_rss_lock);
1794 
1795 	if (process_rss) {
1796 		adapter->current_op = VIRTCHNL_OP_ADD_RSS_CFG;
1797 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_RSS_CFG,
1798 				 (u8 *)rss_cfg, len);
1799 	} else {
1800 		adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_ADV_RSS_CFG;
1801 	}
1802 
1803 	kfree(rss_cfg);
1804 }
1805 
1806 /**
1807  * iavf_del_adv_rss_cfg
1808  * @adapter: the VF adapter structure
1809  *
1810  * Request that the PF delete RSS configuration as specified
1811  * by the user via ethtool.
1812  **/
iavf_del_adv_rss_cfg(struct iavf_adapter * adapter)1813 void iavf_del_adv_rss_cfg(struct iavf_adapter *adapter)
1814 {
1815 	struct virtchnl_rss_cfg *rss_cfg;
1816 	struct iavf_adv_rss *rss;
1817 	bool process_rss = false;
1818 	int len;
1819 
1820 	if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
1821 		/* bail because we already have a command pending */
1822 		dev_err(&adapter->pdev->dev, "Cannot remove RSS configuration, command %d pending\n",
1823 			adapter->current_op);
1824 		return;
1825 	}
1826 
1827 	len = sizeof(struct virtchnl_rss_cfg);
1828 	rss_cfg = kzalloc(len, GFP_KERNEL);
1829 	if (!rss_cfg)
1830 		return;
1831 
1832 	spin_lock_bh(&adapter->adv_rss_lock);
1833 	list_for_each_entry(rss, &adapter->adv_rss_list_head, list) {
1834 		if (rss->state == IAVF_ADV_RSS_DEL_REQUEST) {
1835 			process_rss = true;
1836 			rss->state = IAVF_ADV_RSS_DEL_PENDING;
1837 			memcpy(rss_cfg, &rss->cfg_msg, len);
1838 			break;
1839 		}
1840 	}
1841 	spin_unlock_bh(&adapter->adv_rss_lock);
1842 
1843 	if (process_rss) {
1844 		adapter->current_op = VIRTCHNL_OP_DEL_RSS_CFG;
1845 		iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_RSS_CFG,
1846 				 (u8 *)rss_cfg, len);
1847 	} else {
1848 		adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_ADV_RSS_CFG;
1849 	}
1850 
1851 	kfree(rss_cfg);
1852 }
1853 
1854 /**
1855  * iavf_request_reset
1856  * @adapter: adapter structure
1857  *
1858  * Request that the PF reset this VF. No response is expected.
1859  **/
iavf_request_reset(struct iavf_adapter * adapter)1860 int iavf_request_reset(struct iavf_adapter *adapter)
1861 {
1862 	int err;
1863 	/* Don't check CURRENT_OP - this is always higher priority */
1864 	err = iavf_send_pf_msg(adapter, VIRTCHNL_OP_RESET_VF, NULL, 0);
1865 	adapter->current_op = VIRTCHNL_OP_UNKNOWN;
1866 	return err;
1867 }
1868 
1869 /**
1870  * iavf_netdev_features_vlan_strip_set - update vlan strip status
1871  * @netdev: ptr to netdev being adjusted
1872  * @enable: enable or disable vlan strip
1873  *
1874  * Helper function to change vlan strip status in netdev->features.
1875  */
iavf_netdev_features_vlan_strip_set(struct net_device * netdev,const bool enable)1876 static void iavf_netdev_features_vlan_strip_set(struct net_device *netdev,
1877 						const bool enable)
1878 {
1879 	if (enable)
1880 		netdev->features |= NETIF_F_HW_VLAN_CTAG_RX;
1881 	else
1882 		netdev->features &= ~NETIF_F_HW_VLAN_CTAG_RX;
1883 }
1884 
1885 /**
1886  * iavf_virtchnl_completion
1887  * @adapter: adapter structure
1888  * @v_opcode: opcode sent by PF
1889  * @v_retval: retval sent by PF
1890  * @msg: message sent by PF
1891  * @msglen: message length
1892  *
1893  * Asynchronous completion function for admin queue messages. Rather than busy
1894  * wait, we fire off our requests and assume that no errors will be returned.
1895  * This function handles the reply messages.
1896  **/
iavf_virtchnl_completion(struct iavf_adapter * adapter,enum virtchnl_ops v_opcode,enum iavf_status v_retval,u8 * msg,u16 msglen)1897 void iavf_virtchnl_completion(struct iavf_adapter *adapter,
1898 			      enum virtchnl_ops v_opcode,
1899 			      enum iavf_status v_retval, u8 *msg, u16 msglen)
1900 {
1901 	struct net_device *netdev = adapter->netdev;
1902 
1903 	if (v_opcode == VIRTCHNL_OP_EVENT) {
1904 		struct virtchnl_pf_event *vpe =
1905 			(struct virtchnl_pf_event *)msg;
1906 		bool link_up = iavf_get_vpe_link_status(adapter, vpe);
1907 
1908 		switch (vpe->event) {
1909 		case VIRTCHNL_EVENT_LINK_CHANGE:
1910 			iavf_set_adapter_link_speed_from_vpe(adapter, vpe);
1911 
1912 			/* we've already got the right link status, bail */
1913 			if (adapter->link_up == link_up)
1914 				break;
1915 
1916 			if (link_up) {
1917 				/* If we get link up message and start queues
1918 				 * before our queues are configured it will
1919 				 * trigger a TX hang. In that case, just ignore
1920 				 * the link status message,we'll get another one
1921 				 * after we enable queues and actually prepared
1922 				 * to send traffic.
1923 				 */
1924 				if (adapter->state != __IAVF_RUNNING)
1925 					break;
1926 
1927 				/* For ADq enabled VF, we reconfigure VSIs and
1928 				 * re-allocate queues. Hence wait till all
1929 				 * queues are enabled.
1930 				 */
1931 				if (adapter->flags &
1932 				    IAVF_FLAG_QUEUES_DISABLED)
1933 					break;
1934 			}
1935 
1936 			adapter->link_up = link_up;
1937 			if (link_up) {
1938 				netif_tx_start_all_queues(netdev);
1939 				netif_carrier_on(netdev);
1940 			} else {
1941 				netif_tx_stop_all_queues(netdev);
1942 				netif_carrier_off(netdev);
1943 			}
1944 			iavf_print_link_message(adapter);
1945 			break;
1946 		case VIRTCHNL_EVENT_RESET_IMPENDING:
1947 			dev_info(&adapter->pdev->dev, "Reset indication received from the PF\n");
1948 			if (!(adapter->flags & IAVF_FLAG_RESET_PENDING)) {
1949 				adapter->flags |= IAVF_FLAG_RESET_PENDING;
1950 				dev_info(&adapter->pdev->dev, "Scheduling reset task\n");
1951 				queue_work(iavf_wq, &adapter->reset_task);
1952 			}
1953 			break;
1954 		default:
1955 			dev_err(&adapter->pdev->dev, "Unknown event %d from PF\n",
1956 				vpe->event);
1957 			break;
1958 		}
1959 		return;
1960 	}
1961 	if (v_retval) {
1962 		switch (v_opcode) {
1963 		case VIRTCHNL_OP_ADD_VLAN:
1964 			dev_err(&adapter->pdev->dev, "Failed to add VLAN filter, error %s\n",
1965 				iavf_stat_str(&adapter->hw, v_retval));
1966 			break;
1967 		case VIRTCHNL_OP_ADD_ETH_ADDR:
1968 			dev_err(&adapter->pdev->dev, "Failed to add MAC filter, error %s\n",
1969 				iavf_stat_str(&adapter->hw, v_retval));
1970 			iavf_mac_add_reject(adapter);
1971 			/* restore administratively set MAC address */
1972 			ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
1973 			break;
1974 		case VIRTCHNL_OP_DEL_VLAN:
1975 			dev_err(&adapter->pdev->dev, "Failed to delete VLAN filter, error %s\n",
1976 				iavf_stat_str(&adapter->hw, v_retval));
1977 			break;
1978 		case VIRTCHNL_OP_DEL_ETH_ADDR:
1979 			dev_err(&adapter->pdev->dev, "Failed to delete MAC filter, error %s\n",
1980 				iavf_stat_str(&adapter->hw, v_retval));
1981 			break;
1982 		case VIRTCHNL_OP_ENABLE_CHANNELS:
1983 			dev_err(&adapter->pdev->dev, "Failed to configure queue channels, error %s\n",
1984 				iavf_stat_str(&adapter->hw, v_retval));
1985 			adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
1986 			adapter->ch_config.state = __IAVF_TC_INVALID;
1987 			netdev_reset_tc(netdev);
1988 			netif_tx_start_all_queues(netdev);
1989 			break;
1990 		case VIRTCHNL_OP_DISABLE_CHANNELS:
1991 			dev_err(&adapter->pdev->dev, "Failed to disable queue channels, error %s\n",
1992 				iavf_stat_str(&adapter->hw, v_retval));
1993 			adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
1994 			adapter->ch_config.state = __IAVF_TC_RUNNING;
1995 			netif_tx_start_all_queues(netdev);
1996 			break;
1997 		case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
1998 			struct iavf_cloud_filter *cf, *cftmp;
1999 
2000 			list_for_each_entry_safe(cf, cftmp,
2001 						 &adapter->cloud_filter_list,
2002 						 list) {
2003 				if (cf->state == __IAVF_CF_ADD_PENDING) {
2004 					cf->state = __IAVF_CF_INVALID;
2005 					dev_info(&adapter->pdev->dev, "Failed to add cloud filter, error %s\n",
2006 						 iavf_stat_str(&adapter->hw,
2007 							       v_retval));
2008 					iavf_print_cloud_filter(adapter,
2009 								&cf->f);
2010 					list_del(&cf->list);
2011 					kfree(cf);
2012 					adapter->num_cloud_filters--;
2013 				}
2014 			}
2015 			}
2016 			break;
2017 		case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
2018 			struct iavf_cloud_filter *cf;
2019 
2020 			list_for_each_entry(cf, &adapter->cloud_filter_list,
2021 					    list) {
2022 				if (cf->state == __IAVF_CF_DEL_PENDING) {
2023 					cf->state = __IAVF_CF_ACTIVE;
2024 					dev_info(&adapter->pdev->dev, "Failed to del cloud filter, error %s\n",
2025 						 iavf_stat_str(&adapter->hw,
2026 							       v_retval));
2027 					iavf_print_cloud_filter(adapter,
2028 								&cf->f);
2029 				}
2030 			}
2031 			}
2032 			break;
2033 		case VIRTCHNL_OP_ADD_FDIR_FILTER: {
2034 			struct iavf_fdir_fltr *fdir, *fdir_tmp;
2035 
2036 			spin_lock_bh(&adapter->fdir_fltr_lock);
2037 			list_for_each_entry_safe(fdir, fdir_tmp,
2038 						 &adapter->fdir_list_head,
2039 						 list) {
2040 				if (fdir->state == IAVF_FDIR_FLTR_ADD_PENDING) {
2041 					dev_info(&adapter->pdev->dev, "Failed to add Flow Director filter, error %s\n",
2042 						 iavf_stat_str(&adapter->hw,
2043 							       v_retval));
2044 					iavf_print_fdir_fltr(adapter, fdir);
2045 					if (msglen)
2046 						dev_err(&adapter->pdev->dev,
2047 							"%s\n", msg);
2048 					list_del(&fdir->list);
2049 					kfree(fdir);
2050 					adapter->fdir_active_fltr--;
2051 				}
2052 			}
2053 			spin_unlock_bh(&adapter->fdir_fltr_lock);
2054 			}
2055 			break;
2056 		case VIRTCHNL_OP_DEL_FDIR_FILTER: {
2057 			struct iavf_fdir_fltr *fdir;
2058 
2059 			spin_lock_bh(&adapter->fdir_fltr_lock);
2060 			list_for_each_entry(fdir, &adapter->fdir_list_head,
2061 					    list) {
2062 				if (fdir->state == IAVF_FDIR_FLTR_DEL_PENDING) {
2063 					fdir->state = IAVF_FDIR_FLTR_ACTIVE;
2064 					dev_info(&adapter->pdev->dev, "Failed to del Flow Director filter, error %s\n",
2065 						 iavf_stat_str(&adapter->hw,
2066 							       v_retval));
2067 					iavf_print_fdir_fltr(adapter, fdir);
2068 				}
2069 			}
2070 			spin_unlock_bh(&adapter->fdir_fltr_lock);
2071 			}
2072 			break;
2073 		case VIRTCHNL_OP_ADD_RSS_CFG: {
2074 			struct iavf_adv_rss *rss, *rss_tmp;
2075 
2076 			spin_lock_bh(&adapter->adv_rss_lock);
2077 			list_for_each_entry_safe(rss, rss_tmp,
2078 						 &adapter->adv_rss_list_head,
2079 						 list) {
2080 				if (rss->state == IAVF_ADV_RSS_ADD_PENDING) {
2081 					iavf_print_adv_rss_cfg(adapter, rss,
2082 							       "Failed to change the input set for",
2083 							       NULL);
2084 					list_del(&rss->list);
2085 					kfree(rss);
2086 				}
2087 			}
2088 			spin_unlock_bh(&adapter->adv_rss_lock);
2089 			}
2090 			break;
2091 		case VIRTCHNL_OP_DEL_RSS_CFG: {
2092 			struct iavf_adv_rss *rss;
2093 
2094 			spin_lock_bh(&adapter->adv_rss_lock);
2095 			list_for_each_entry(rss, &adapter->adv_rss_list_head,
2096 					    list) {
2097 				if (rss->state == IAVF_ADV_RSS_DEL_PENDING) {
2098 					rss->state = IAVF_ADV_RSS_ACTIVE;
2099 					dev_err(&adapter->pdev->dev, "Failed to delete RSS configuration, error %s\n",
2100 						iavf_stat_str(&adapter->hw,
2101 							      v_retval));
2102 				}
2103 			}
2104 			spin_unlock_bh(&adapter->adv_rss_lock);
2105 			}
2106 			break;
2107 		case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING:
2108 			dev_warn(&adapter->pdev->dev, "Changing VLAN Stripping is not allowed when Port VLAN is configured\n");
2109 			/* Vlan stripping could not be enabled by ethtool.
2110 			 * Disable it in netdev->features.
2111 			 */
2112 			iavf_netdev_features_vlan_strip_set(netdev, false);
2113 			break;
2114 		case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING:
2115 			dev_warn(&adapter->pdev->dev, "Changing VLAN Stripping is not allowed when Port VLAN is configured\n");
2116 			/* Vlan stripping could not be disabled by ethtool.
2117 			 * Enable it in netdev->features.
2118 			 */
2119 			iavf_netdev_features_vlan_strip_set(netdev, true);
2120 			break;
2121 		case VIRTCHNL_OP_ADD_VLAN_V2:
2122 			iavf_vlan_add_reject(adapter);
2123 			dev_warn(&adapter->pdev->dev, "Failed to add VLAN filter, error %s\n",
2124 				 iavf_stat_str(&adapter->hw, v_retval));
2125 			break;
2126 		default:
2127 			dev_err(&adapter->pdev->dev, "PF returned error %d (%s) to our request %d\n",
2128 				v_retval, iavf_stat_str(&adapter->hw, v_retval),
2129 				v_opcode);
2130 		}
2131 	}
2132 	switch (v_opcode) {
2133 	case VIRTCHNL_OP_ADD_ETH_ADDR:
2134 		if (!v_retval)
2135 			iavf_mac_add_ok(adapter);
2136 		if (!ether_addr_equal(netdev->dev_addr, adapter->hw.mac.addr))
2137 			eth_hw_addr_set(netdev, adapter->hw.mac.addr);
2138 		break;
2139 	case VIRTCHNL_OP_GET_STATS: {
2140 		struct iavf_eth_stats *stats =
2141 			(struct iavf_eth_stats *)msg;
2142 		netdev->stats.rx_packets = stats->rx_unicast +
2143 					   stats->rx_multicast +
2144 					   stats->rx_broadcast;
2145 		netdev->stats.tx_packets = stats->tx_unicast +
2146 					   stats->tx_multicast +
2147 					   stats->tx_broadcast;
2148 		netdev->stats.rx_bytes = stats->rx_bytes;
2149 		netdev->stats.tx_bytes = stats->tx_bytes;
2150 		netdev->stats.tx_errors = stats->tx_errors;
2151 		netdev->stats.rx_dropped = stats->rx_discards;
2152 		netdev->stats.tx_dropped = stats->tx_discards;
2153 		adapter->current_stats = *stats;
2154 		}
2155 		break;
2156 	case VIRTCHNL_OP_GET_VF_RESOURCES: {
2157 		u16 len = sizeof(struct virtchnl_vf_resource) +
2158 			  IAVF_MAX_VF_VSI *
2159 			  sizeof(struct virtchnl_vsi_resource);
2160 		memcpy(adapter->vf_res, msg, min(msglen, len));
2161 		iavf_validate_num_queues(adapter);
2162 		iavf_vf_parse_hw_config(&adapter->hw, adapter->vf_res);
2163 		if (is_zero_ether_addr(adapter->hw.mac.addr)) {
2164 			/* restore current mac address */
2165 			ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
2166 		} else {
2167 			/* refresh current mac address if changed */
2168 			eth_hw_addr_set(netdev, adapter->hw.mac.addr);
2169 			ether_addr_copy(netdev->perm_addr,
2170 					adapter->hw.mac.addr);
2171 		}
2172 		spin_lock_bh(&adapter->mac_vlan_list_lock);
2173 		iavf_add_filter(adapter, adapter->hw.mac.addr);
2174 
2175 		if (VLAN_ALLOWED(adapter)) {
2176 			if (!list_empty(&adapter->vlan_filter_list)) {
2177 				struct iavf_vlan_filter *vlf;
2178 
2179 				/* re-add all VLAN filters over virtchnl */
2180 				list_for_each_entry(vlf,
2181 						    &adapter->vlan_filter_list,
2182 						    list)
2183 					vlf->add = true;
2184 
2185 				adapter->aq_required |=
2186 					IAVF_FLAG_AQ_ADD_VLAN_FILTER;
2187 			}
2188 		}
2189 
2190 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
2191 
2192 		iavf_parse_vf_resource_msg(adapter);
2193 
2194 		/* negotiated VIRTCHNL_VF_OFFLOAD_VLAN_V2, so wait for the
2195 		 * response to VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS to finish
2196 		 * configuration
2197 		 */
2198 		if (VLAN_V2_ALLOWED(adapter))
2199 			break;
2200 		/* fallthrough and finish config if VIRTCHNL_VF_OFFLOAD_VLAN_V2
2201 		 * wasn't successfully negotiated with the PF
2202 		 */
2203 		}
2204 		fallthrough;
2205 	case VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS: {
2206 		if (v_opcode == VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS)
2207 			memcpy(&adapter->vlan_v2_caps, msg,
2208 			       min_t(u16, msglen,
2209 				     sizeof(adapter->vlan_v2_caps)));
2210 
2211 		iavf_process_config(adapter);
2212 		adapter->flags |= IAVF_FLAG_SETUP_NETDEV_FEATURES;
2213 		}
2214 		break;
2215 	case VIRTCHNL_OP_ENABLE_QUEUES:
2216 		/* enable transmits */
2217 		iavf_irq_enable(adapter, true);
2218 		adapter->flags &= ~IAVF_FLAG_QUEUES_DISABLED;
2219 		break;
2220 	case VIRTCHNL_OP_DISABLE_QUEUES:
2221 		iavf_free_all_tx_resources(adapter);
2222 		iavf_free_all_rx_resources(adapter);
2223 		if (adapter->state == __IAVF_DOWN_PENDING) {
2224 			iavf_change_state(adapter, __IAVF_DOWN);
2225 			wake_up(&adapter->down_waitqueue);
2226 		}
2227 		break;
2228 	case VIRTCHNL_OP_VERSION:
2229 	case VIRTCHNL_OP_CONFIG_IRQ_MAP:
2230 		/* Don't display an error if we get these out of sequence.
2231 		 * If the firmware needed to get kicked, we'll get these and
2232 		 * it's no problem.
2233 		 */
2234 		if (v_opcode != adapter->current_op)
2235 			return;
2236 		break;
2237 	case VIRTCHNL_OP_IWARP:
2238 		/* Gobble zero-length replies from the PF. They indicate that
2239 		 * a previous message was received OK, and the client doesn't
2240 		 * care about that.
2241 		 */
2242 		if (msglen && CLIENT_ENABLED(adapter))
2243 			iavf_notify_client_message(&adapter->vsi, msg, msglen);
2244 		break;
2245 
2246 	case VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP:
2247 		adapter->client_pending &=
2248 				~(BIT(VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP));
2249 		break;
2250 	case VIRTCHNL_OP_GET_RSS_HENA_CAPS: {
2251 		struct virtchnl_rss_hena *vrh = (struct virtchnl_rss_hena *)msg;
2252 
2253 		if (msglen == sizeof(*vrh))
2254 			adapter->hena = vrh->hena;
2255 		else
2256 			dev_warn(&adapter->pdev->dev,
2257 				 "Invalid message %d from PF\n", v_opcode);
2258 		}
2259 		break;
2260 	case VIRTCHNL_OP_REQUEST_QUEUES: {
2261 		struct virtchnl_vf_res_request *vfres =
2262 			(struct virtchnl_vf_res_request *)msg;
2263 
2264 		if (vfres->num_queue_pairs != adapter->num_req_queues) {
2265 			dev_info(&adapter->pdev->dev,
2266 				 "Requested %d queues, PF can support %d\n",
2267 				 adapter->num_req_queues,
2268 				 vfres->num_queue_pairs);
2269 			adapter->num_req_queues = 0;
2270 			adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
2271 		}
2272 		}
2273 		break;
2274 	case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
2275 		struct iavf_cloud_filter *cf;
2276 
2277 		list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
2278 			if (cf->state == __IAVF_CF_ADD_PENDING)
2279 				cf->state = __IAVF_CF_ACTIVE;
2280 		}
2281 		}
2282 		break;
2283 	case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
2284 		struct iavf_cloud_filter *cf, *cftmp;
2285 
2286 		list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list,
2287 					 list) {
2288 			if (cf->state == __IAVF_CF_DEL_PENDING) {
2289 				cf->state = __IAVF_CF_INVALID;
2290 				list_del(&cf->list);
2291 				kfree(cf);
2292 				adapter->num_cloud_filters--;
2293 			}
2294 		}
2295 		}
2296 		break;
2297 	case VIRTCHNL_OP_ADD_FDIR_FILTER: {
2298 		struct virtchnl_fdir_add *add_fltr = (struct virtchnl_fdir_add *)msg;
2299 		struct iavf_fdir_fltr *fdir, *fdir_tmp;
2300 
2301 		spin_lock_bh(&adapter->fdir_fltr_lock);
2302 		list_for_each_entry_safe(fdir, fdir_tmp,
2303 					 &adapter->fdir_list_head,
2304 					 list) {
2305 			if (fdir->state == IAVF_FDIR_FLTR_ADD_PENDING) {
2306 				if (add_fltr->status == VIRTCHNL_FDIR_SUCCESS) {
2307 					dev_info(&adapter->pdev->dev, "Flow Director filter with location %u is added\n",
2308 						 fdir->loc);
2309 					fdir->state = IAVF_FDIR_FLTR_ACTIVE;
2310 					fdir->flow_id = add_fltr->flow_id;
2311 				} else {
2312 					dev_info(&adapter->pdev->dev, "Failed to add Flow Director filter with status: %d\n",
2313 						 add_fltr->status);
2314 					iavf_print_fdir_fltr(adapter, fdir);
2315 					list_del(&fdir->list);
2316 					kfree(fdir);
2317 					adapter->fdir_active_fltr--;
2318 				}
2319 			}
2320 		}
2321 		spin_unlock_bh(&adapter->fdir_fltr_lock);
2322 		}
2323 		break;
2324 	case VIRTCHNL_OP_DEL_FDIR_FILTER: {
2325 		struct virtchnl_fdir_del *del_fltr = (struct virtchnl_fdir_del *)msg;
2326 		struct iavf_fdir_fltr *fdir, *fdir_tmp;
2327 
2328 		spin_lock_bh(&adapter->fdir_fltr_lock);
2329 		list_for_each_entry_safe(fdir, fdir_tmp, &adapter->fdir_list_head,
2330 					 list) {
2331 			if (fdir->state == IAVF_FDIR_FLTR_DEL_PENDING) {
2332 				if (del_fltr->status == VIRTCHNL_FDIR_SUCCESS) {
2333 					dev_info(&adapter->pdev->dev, "Flow Director filter with location %u is deleted\n",
2334 						 fdir->loc);
2335 					list_del(&fdir->list);
2336 					kfree(fdir);
2337 					adapter->fdir_active_fltr--;
2338 				} else {
2339 					fdir->state = IAVF_FDIR_FLTR_ACTIVE;
2340 					dev_info(&adapter->pdev->dev, "Failed to delete Flow Director filter with status: %d\n",
2341 						 del_fltr->status);
2342 					iavf_print_fdir_fltr(adapter, fdir);
2343 				}
2344 			}
2345 		}
2346 		spin_unlock_bh(&adapter->fdir_fltr_lock);
2347 		}
2348 		break;
2349 	case VIRTCHNL_OP_ADD_RSS_CFG: {
2350 		struct iavf_adv_rss *rss;
2351 
2352 		spin_lock_bh(&adapter->adv_rss_lock);
2353 		list_for_each_entry(rss, &adapter->adv_rss_list_head, list) {
2354 			if (rss->state == IAVF_ADV_RSS_ADD_PENDING) {
2355 				iavf_print_adv_rss_cfg(adapter, rss,
2356 						       "Input set change for",
2357 						       "successful");
2358 				rss->state = IAVF_ADV_RSS_ACTIVE;
2359 			}
2360 		}
2361 		spin_unlock_bh(&adapter->adv_rss_lock);
2362 		}
2363 		break;
2364 	case VIRTCHNL_OP_DEL_RSS_CFG: {
2365 		struct iavf_adv_rss *rss, *rss_tmp;
2366 
2367 		spin_lock_bh(&adapter->adv_rss_lock);
2368 		list_for_each_entry_safe(rss, rss_tmp,
2369 					 &adapter->adv_rss_list_head, list) {
2370 			if (rss->state == IAVF_ADV_RSS_DEL_PENDING) {
2371 				list_del(&rss->list);
2372 				kfree(rss);
2373 			}
2374 		}
2375 		spin_unlock_bh(&adapter->adv_rss_lock);
2376 		}
2377 		break;
2378 	case VIRTCHNL_OP_ADD_VLAN_V2: {
2379 		struct iavf_vlan_filter *f;
2380 
2381 		spin_lock_bh(&adapter->mac_vlan_list_lock);
2382 		list_for_each_entry(f, &adapter->vlan_filter_list, list) {
2383 			if (f->is_new_vlan) {
2384 				f->is_new_vlan = false;
2385 				if (f->vlan.tpid == ETH_P_8021Q)
2386 					set_bit(f->vlan.vid,
2387 						adapter->vsi.active_cvlans);
2388 				else
2389 					set_bit(f->vlan.vid,
2390 						adapter->vsi.active_svlans);
2391 			}
2392 		}
2393 		spin_unlock_bh(&adapter->mac_vlan_list_lock);
2394 		}
2395 		break;
2396 	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING:
2397 		/* PF enabled vlan strip on this VF.
2398 		 * Update netdev->features if needed to be in sync with ethtool.
2399 		 */
2400 		if (!v_retval)
2401 			iavf_netdev_features_vlan_strip_set(netdev, true);
2402 		break;
2403 	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING:
2404 		/* PF disabled vlan strip on this VF.
2405 		 * Update netdev->features if needed to be in sync with ethtool.
2406 		 */
2407 		if (!v_retval)
2408 			iavf_netdev_features_vlan_strip_set(netdev, false);
2409 		break;
2410 	default:
2411 		if (adapter->current_op && (v_opcode != adapter->current_op))
2412 			dev_warn(&adapter->pdev->dev, "Expected response %d from PF, received %d\n",
2413 				 adapter->current_op, v_opcode);
2414 		break;
2415 	} /* switch v_opcode */
2416 	adapter->current_op = VIRTCHNL_OP_UNKNOWN;
2417 }
2418