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