projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
hyperv: Add hash value into RNDIS Per-packet info
[linux-2.6-block.git] / drivers / net / ethernet / intel / i40e / i40e_virtchnl_pf.c
CommitLineData
5c3c48ac
JB		 1/*******************************************************************************
2 *
3 * Intel Ethernet Controller XL710 Family Linux Driver
dc641b73 4 * Copyright(c) 2013 - 2014 Intel Corporation.
5c3c48ac
JB		 5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
13 * more details.
14 *
dc641b73
GR		 15 * You should have received a copy of the GNU General Public License along
16 * with this program. If not, see <http://www.gnu.org/licenses/>.
5c3c48ac
JB		 17 *
18 * The full GNU General Public License is included in this distribution in
19 * the file called "COPYING".
20 *
21 * Contact Information:
22 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24 *
25 ******************************************************************************/
26
27#include "i40e.h"
28
29/***********************misc routines*****************************/
30
f9b4b627
GR		 31/**
32 * i40e_vc_disable_vf
33 * @pf: pointer to the pf info
34 * @vf: pointer to the vf info
35 *
36 * Disable the VF through a SW reset
37 **/
38static inline void i40e_vc_disable_vf(struct i40e_pf *pf, struct i40e_vf *vf)
39{
40 struct i40e_hw *hw = &pf->hw;
41 u32 reg;
42
43 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id));
44 reg |= I40E_VPGEN_VFRTRIG_VFSWR_MASK;
45 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg);
46 i40e_flush(hw);
47}
48
5c3c48ac
JB		 49/**
50 * i40e_vc_isvalid_vsi_id
51 * @vf: pointer to the vf info
52 * @vsi_id: vf relative vsi id
53 *
54 * check for the valid vsi id
55 **/
56static inline bool i40e_vc_isvalid_vsi_id(struct i40e_vf *vf, u8 vsi_id)
57{
58 struct i40e_pf *pf = vf->pf;
59
60 return pf->vsi[vsi_id]->vf_id == vf->vf_id;
61}
62
63/**
64 * i40e_vc_isvalid_queue_id
65 * @vf: pointer to the vf info
66 * @vsi_id: vsi id
67 * @qid: vsi relative queue id
68 *
69 * check for the valid queue id
70 **/
71static inline bool i40e_vc_isvalid_queue_id(struct i40e_vf *vf, u8 vsi_id,
72 u8 qid)
73{
74 struct i40e_pf *pf = vf->pf;
75
76 return qid < pf->vsi[vsi_id]->num_queue_pairs;
77}
78
79/**
80 * i40e_vc_isvalid_vector_id
81 * @vf: pointer to the vf info
82 * @vector_id: vf relative vector id
83 *
84 * check for the valid vector id
85 **/
86static inline bool i40e_vc_isvalid_vector_id(struct i40e_vf *vf, u8 vector_id)
87{
88 struct i40e_pf *pf = vf->pf;
89
9347eb77 90 return vector_id < pf->hw.func_caps.num_msix_vectors_vf;
5c3c48ac
JB		 91}
92
93/***********************vf resource mgmt routines*****************/
94
95/**
96 * i40e_vc_get_pf_queue_id
97 * @vf: pointer to the vf info
98 * @vsi_idx: index of VSI in PF struct
99 * @vsi_queue_id: vsi relative queue id
100 *
101 * return pf relative queue id
102 **/
103static u16 i40e_vc_get_pf_queue_id(struct i40e_vf *vf, u8 vsi_idx,
104 u8 vsi_queue_id)
105{
106 struct i40e_pf *pf = vf->pf;
107 struct i40e_vsi *vsi = pf->vsi[vsi_idx];
108 u16 pf_queue_id = I40E_QUEUE_END_OF_LIST;
109
110 if (le16_to_cpu(vsi->info.mapping_flags) &
111 I40E_AQ_VSI_QUE_MAP_NONCONTIG)
112 pf_queue_id =
113 le16_to_cpu(vsi->info.queue_mapping[vsi_queue_id]);
114 else
115 pf_queue_id = le16_to_cpu(vsi->info.queue_mapping[0]) +
116 vsi_queue_id;
117
118 return pf_queue_id;
119}
120
5c3c48ac
JB		 121/**
122 * i40e_config_irq_link_list
123 * @vf: pointer to the vf info
124 * @vsi_idx: index of VSI in PF struct
125 * @vecmap: irq map info
126 *
127 * configure irq link list from the map
128 **/
129static void i40e_config_irq_link_list(struct i40e_vf *vf, u16 vsi_idx,
130 struct i40e_virtchnl_vector_map *vecmap)
131{
132 unsigned long linklistmap = 0, tempmap;
133 struct i40e_pf *pf = vf->pf;
134 struct i40e_hw *hw = &pf->hw;
135 u16 vsi_queue_id, pf_queue_id;
136 enum i40e_queue_type qtype;
137 u16 next_q, vector_id;
138 u32 reg, reg_idx;
139 u16 itr_idx = 0;
140
141 vector_id = vecmap->vector_id;
142 /* setup the head */
143 if (0 == vector_id)
144 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id);
145 else
146 reg_idx = I40E_VPINT_LNKLSTN(
9347eb77
MW		 147 ((pf->hw.func_caps.num_msix_vectors_vf - 1) * vf->vf_id) +
148 (vector_id - 1));
5c3c48ac
JB		 149
150 if (vecmap->rxq_map == 0 && vecmap->txq_map == 0) {
151 /* Special case - No queues mapped on this vector */
152 wr32(hw, reg_idx, I40E_VPINT_LNKLST0_FIRSTQ_INDX_MASK);
153 goto irq_list_done;
154 }
155 tempmap = vecmap->rxq_map;
4836650b 156 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
5c3c48ac
JB		 157 linklistmap |= (1 <<
158 (I40E_VIRTCHNL_SUPPORTED_QTYPES *
159 vsi_queue_id));
5c3c48ac
JB		 160 }
161
162 tempmap = vecmap->txq_map;
4836650b 163 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
5c3c48ac
JB		 164 linklistmap |= (1 <<
165 (I40E_VIRTCHNL_SUPPORTED_QTYPES * vsi_queue_id
166 + 1));
5c3c48ac
JB		 167 }
168
169 next_q = find_first_bit(&linklistmap,
170 (I40E_MAX_VSI_QP *
171 I40E_VIRTCHNL_SUPPORTED_QTYPES));
172 vsi_queue_id = next_q/I40E_VIRTCHNL_SUPPORTED_QTYPES;
173 qtype = next_q%I40E_VIRTCHNL_SUPPORTED_QTYPES;
174 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_idx, vsi_queue_id);
175 reg = ((qtype << I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT) | pf_queue_id);
176
177 wr32(hw, reg_idx, reg);
178
179 while (next_q < (I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES)) {
180 switch (qtype) {
181 case I40E_QUEUE_TYPE_RX:
182 reg_idx = I40E_QINT_RQCTL(pf_queue_id);
183 itr_idx = vecmap->rxitr_idx;
184 break;
185 case I40E_QUEUE_TYPE_TX:
186 reg_idx = I40E_QINT_TQCTL(pf_queue_id);
187 itr_idx = vecmap->txitr_idx;
188 break;
189 default:
190 break;
191 }
192
193 next_q = find_next_bit(&linklistmap,
194 (I40E_MAX_VSI_QP *
195 I40E_VIRTCHNL_SUPPORTED_QTYPES),
196 next_q + 1);
829af3ac
MW		 197 if (next_q <
198 (I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES)) {
5c3c48ac
JB		 199 vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES;
200 qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES;
201 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_idx,
202 vsi_queue_id);
203 } else {
204 pf_queue_id = I40E_QUEUE_END_OF_LIST;
205 qtype = 0;
206 }
207
208 /* format for the RQCTL & TQCTL regs is same */
209 reg = (vector_id) |
210 (qtype << I40E_QINT_RQCTL_NEXTQ_TYPE_SHIFT) |
211 (pf_queue_id << I40E_QINT_RQCTL_NEXTQ_INDX_SHIFT) |
212 (1 << I40E_QINT_RQCTL_CAUSE_ENA_SHIFT) |
213 (itr_idx << I40E_QINT_RQCTL_ITR_INDX_SHIFT);
214 wr32(hw, reg_idx, reg);
215 }
216
217irq_list_done:
218 i40e_flush(hw);
219}
220
221/**
222 * i40e_config_vsi_tx_queue
223 * @vf: pointer to the vf info
224 * @vsi_idx: index of VSI in PF struct
225 * @vsi_queue_id: vsi relative queue index
226 * @info: config. info
227 *
228 * configure tx queue
229 **/
230static int i40e_config_vsi_tx_queue(struct i40e_vf *vf, u16 vsi_idx,
231 u16 vsi_queue_id,
232 struct i40e_virtchnl_txq_info *info)
233{
234 struct i40e_pf *pf = vf->pf;
235 struct i40e_hw *hw = &pf->hw;
236 struct i40e_hmc_obj_txq tx_ctx;
237 u16 pf_queue_id;
238 u32 qtx_ctl;
239 int ret = 0;
240
241 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_idx, vsi_queue_id);
242
243 /* clear the context structure first */
244 memset(&tx_ctx, 0, sizeof(struct i40e_hmc_obj_txq));
245
246 /* only set the required fields */
247 tx_ctx.base = info->dma_ring_addr / 128;
248 tx_ctx.qlen = info->ring_len;
249 tx_ctx.rdylist = le16_to_cpu(pf->vsi[vsi_idx]->info.qs_handle[0]);
250 tx_ctx.rdylist_act = 0;
1943d8ba
JB		 251 tx_ctx.head_wb_ena = 1;
252 tx_ctx.head_wb_addr = info->dma_ring_addr +
253 (info->ring_len * sizeof(struct i40e_tx_desc));
5c3c48ac
JB		 254
255 /* clear the context in the HMC */
256 ret = i40e_clear_lan_tx_queue_context(hw, pf_queue_id);
257 if (ret) {
258 dev_err(&pf->pdev->dev,
259 "Failed to clear VF LAN Tx queue context %d, error: %d\n",
260 pf_queue_id, ret);
261 ret = -ENOENT;
262 goto error_context;
263 }
264
265 /* set the context in the HMC */
266 ret = i40e_set_lan_tx_queue_context(hw, pf_queue_id, &tx_ctx);
267 if (ret) {
268 dev_err(&pf->pdev->dev,
269 "Failed to set VF LAN Tx queue context %d error: %d\n",
270 pf_queue_id, ret);
271 ret = -ENOENT;
272 goto error_context;
273 }
274
275 /* associate this queue with the PCI VF function */
276 qtx_ctl = I40E_QTX_CTL_VF_QUEUE;
13fd9774 277 qtx_ctl |= ((hw->pf_id << I40E_QTX_CTL_PF_INDX_SHIFT)
5c3c48ac
JB		 278 & I40E_QTX_CTL_PF_INDX_MASK);
279 qtx_ctl |= (((vf->vf_id + hw->func_caps.vf_base_id)
280 << I40E_QTX_CTL_VFVM_INDX_SHIFT)
281 & I40E_QTX_CTL_VFVM_INDX_MASK);
282 wr32(hw, I40E_QTX_CTL(pf_queue_id), qtx_ctl);
283 i40e_flush(hw);
284
285error_context:
286 return ret;
287}
288
289/**
290 * i40e_config_vsi_rx_queue
291 * @vf: pointer to the vf info
292 * @vsi_idx: index of VSI in PF struct
293 * @vsi_queue_id: vsi relative queue index
294 * @info: config. info
295 *
296 * configure rx queue
297 **/
298static int i40e_config_vsi_rx_queue(struct i40e_vf *vf, u16 vsi_idx,
299 u16 vsi_queue_id,
300 struct i40e_virtchnl_rxq_info *info)
301{
302 struct i40e_pf *pf = vf->pf;
303 struct i40e_hw *hw = &pf->hw;
304 struct i40e_hmc_obj_rxq rx_ctx;
305 u16 pf_queue_id;
306 int ret = 0;
307
308 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_idx, vsi_queue_id);
309
310 /* clear the context structure first */
311 memset(&rx_ctx, 0, sizeof(struct i40e_hmc_obj_rxq));
312
313 /* only set the required fields */
314 rx_ctx.base = info->dma_ring_addr / 128;
315 rx_ctx.qlen = info->ring_len;
316
317 if (info->splithdr_enabled) {
318 rx_ctx.hsplit_0 = I40E_RX_SPLIT_L2 |
319 I40E_RX_SPLIT_IP |
320 I40E_RX_SPLIT_TCP_UDP |
321 I40E_RX_SPLIT_SCTP;
322 /* header length validation */
323 if (info->hdr_size > ((2 * 1024) - 64)) {
324 ret = -EINVAL;
325 goto error_param;
326 }
327 rx_ctx.hbuff = info->hdr_size >> I40E_RXQ_CTX_HBUFF_SHIFT;
328
329 /* set splitalways mode 10b */
330 rx_ctx.dtype = 0x2;
331 }
332
333 /* databuffer length validation */
334 if (info->databuffer_size > ((16 * 1024) - 128)) {
335 ret = -EINVAL;
336 goto error_param;
337 }
338 rx_ctx.dbuff = info->databuffer_size >> I40E_RXQ_CTX_DBUFF_SHIFT;
339
340 /* max pkt. length validation */
341 if (info->max_pkt_size >= (16 * 1024) || info->max_pkt_size < 64) {
342 ret = -EINVAL;
343 goto error_param;
344 }
345 rx_ctx.rxmax = info->max_pkt_size;
346
347 /* enable 32bytes desc always */
348 rx_ctx.dsize = 1;
349
350 /* default values */
351 rx_ctx.tphrdesc_ena = 1;
352 rx_ctx.tphwdesc_ena = 1;
353 rx_ctx.tphdata_ena = 1;
354 rx_ctx.tphhead_ena = 1;
355 rx_ctx.lrxqthresh = 2;
356 rx_ctx.crcstrip = 1;
357
358 /* clear the context in the HMC */
359 ret = i40e_clear_lan_rx_queue_context(hw, pf_queue_id);
360 if (ret) {
361 dev_err(&pf->pdev->dev,
362 "Failed to clear VF LAN Rx queue context %d, error: %d\n",
363 pf_queue_id, ret);
364 ret = -ENOENT;
365 goto error_param;
366 }
367
368 /* set the context in the HMC */
369 ret = i40e_set_lan_rx_queue_context(hw, pf_queue_id, &rx_ctx);
370 if (ret) {
371 dev_err(&pf->pdev->dev,
372 "Failed to set VF LAN Rx queue context %d error: %d\n",
373 pf_queue_id, ret);
374 ret = -ENOENT;
375 goto error_param;
376 }
377
378error_param:
379 return ret;
380}
381
382/**
383 * i40e_alloc_vsi_res
384 * @vf: pointer to the vf info
385 * @type: type of VSI to allocate
386 *
387 * alloc vf vsi context & resources
388 **/
389static int i40e_alloc_vsi_res(struct i40e_vf *vf, enum i40e_vsi_type type)
390{
391 struct i40e_mac_filter *f = NULL;
392 struct i40e_pf *pf = vf->pf;
5c3c48ac
JB		 393 struct i40e_vsi *vsi;
394 int ret = 0;
395
396 vsi = i40e_vsi_setup(pf, type, pf->vsi[pf->lan_vsi]->seid, vf->vf_id);
397
398 if (!vsi) {
399 dev_err(&pf->pdev->dev,
400 "add vsi failed for vf %d, aq_err %d\n",
401 vf->vf_id, pf->hw.aq.asq_last_status);
402 ret = -ENOENT;
403 goto error_alloc_vsi_res;
404 }
405 if (type == I40E_VSI_SRIOV) {
1a10370a 406 u8 brdcast[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
5c3c48ac
JB		 407 vf->lan_vsi_index = vsi->idx;
408 vf->lan_vsi_id = vsi->id;
409 dev_info(&pf->pdev->dev,
d4194996
MW		 410 "VF %d assigned LAN VSI index %d, VSI id %d\n",
411 vf->vf_id, vsi->idx, vsi->id);
6c12fcbf
GR		 412 /* If the port VLAN has been configured and then the
413 * VF driver was removed then the VSI port VLAN
414 * configuration was destroyed. Check if there is
415 * a port VLAN and restore the VSI configuration if
416 * needed.
417 */
418 if (vf->port_vlan_id)
419 i40e_vsi_add_pvid(vsi, vf->port_vlan_id);
5c3c48ac 420 f = i40e_add_filter(vsi, vf->default_lan_addr.addr,
6c12fcbf 421 vf->port_vlan_id, true, false);
1a10370a
GR		 422 if (!f)
423 dev_info(&pf->pdev->dev,
424 "Could not allocate VF MAC addr\n");
425 f = i40e_add_filter(vsi, brdcast, vf->port_vlan_id,
426 true, false);
427 if (!f)
428 dev_info(&pf->pdev->dev,
429 "Could not allocate VF broadcast filter\n");
5c3c48ac 430 }
6dbbbfb2 431
5c3c48ac
JB		 432 /* program mac filter */
433 ret = i40e_sync_vsi_filters(vsi);
fd1646ee 434 if (ret)
5c3c48ac 435 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n");
5c3c48ac 436
6b192891
MW		 437 /* Set VF bandwidth if specified */
438 if (vf->tx_rate) {
439 ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid,
440 vf->tx_rate / 50, 0, NULL);
441 if (ret)
442 dev_err(&pf->pdev->dev, "Unable to set tx rate, VF %d, error code %d.\n",
443 vf->vf_id, ret);
444 }
445
5c3c48ac
JB		 446error_alloc_vsi_res:
447 return ret;
448}
449
805bd5bd
MW		 450/**
451 * i40e_enable_vf_mappings
452 * @vf: pointer to the vf info
453 *
454 * enable vf mappings
455 **/
456static void i40e_enable_vf_mappings(struct i40e_vf *vf)
457{
458 struct i40e_pf *pf = vf->pf;
459 struct i40e_hw *hw = &pf->hw;
460 u32 reg, total_queue_pairs = 0;
461 int j;
462
463 /* Tell the hardware we're using noncontiguous mapping. HW requires
464 * that VF queues be mapped using this method, even when they are
465 * contiguous in real life
466 */
467 wr32(hw, I40E_VSILAN_QBASE(vf->lan_vsi_id),
468 I40E_VSILAN_QBASE_VSIQTABLE_ENA_MASK);
469
470 /* enable VF vplan_qtable mappings */
471 reg = I40E_VPLAN_MAPENA_TXRX_ENA_MASK;
472 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), reg);
473
474 /* map PF queues to VF queues */
475 for (j = 0; j < pf->vsi[vf->lan_vsi_index]->num_queue_pairs; j++) {
476 u16 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_index, j);
477 reg = (qid & I40E_VPLAN_QTABLE_QINDEX_MASK);
478 wr32(hw, I40E_VPLAN_QTABLE(total_queue_pairs, vf->vf_id), reg);
479 total_queue_pairs++;
480 }
481
482 /* map PF queues to VSI */
483 for (j = 0; j < 7; j++) {
484 if (j * 2 >= pf->vsi[vf->lan_vsi_index]->num_queue_pairs) {
485 reg = 0x07FF07FF; /* unused */
486 } else {
487 u16 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_index,
488 j * 2);
489 reg = qid;
490 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_index,
491 (j * 2) + 1);
492 reg |= qid << 16;
493 }
494 wr32(hw, I40E_VSILAN_QTABLE(j, vf->lan_vsi_id), reg);
495 }
496
497 i40e_flush(hw);
498}
499
500/**
501 * i40e_disable_vf_mappings
502 * @vf: pointer to the vf info
503 *
504 * disable vf mappings
505 **/
506static void i40e_disable_vf_mappings(struct i40e_vf *vf)
507{
508 struct i40e_pf *pf = vf->pf;
509 struct i40e_hw *hw = &pf->hw;
510 int i;
511
512 /* disable qp mappings */
513 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), 0);
514 for (i = 0; i < I40E_MAX_VSI_QP; i++)
515 wr32(hw, I40E_VPLAN_QTABLE(i, vf->vf_id),
516 I40E_QUEUE_END_OF_LIST);
517 i40e_flush(hw);
518}
519
520/**
521 * i40e_free_vf_res
522 * @vf: pointer to the vf info
523 *
524 * free vf resources
525 **/
526static void i40e_free_vf_res(struct i40e_vf *vf)
527{
528 struct i40e_pf *pf = vf->pf;
fc18eaa0
MW		 529 struct i40e_hw *hw = &pf->hw;
530 u32 reg_idx, reg;
531 int i, msix_vf;
805bd5bd
MW		 532
533 /* free vsi & disconnect it from the parent uplink */
534 if (vf->lan_vsi_index) {
535 i40e_vsi_release(pf->vsi[vf->lan_vsi_index]);
536 vf->lan_vsi_index = 0;
537 vf->lan_vsi_id = 0;
538 }
9347eb77
MW		 539 msix_vf = pf->hw.func_caps.num_msix_vectors_vf;
540
fc18eaa0
MW		 541 /* disable interrupts so the VF starts in a known state */
542 for (i = 0; i < msix_vf; i++) {
543 /* format is same for both registers */
544 if (0 == i)
545 reg_idx = I40E_VFINT_DYN_CTL0(vf->vf_id);
546 else
547 reg_idx = I40E_VFINT_DYN_CTLN(((msix_vf - 1) *
548 (vf->vf_id))
549 + (i - 1));
550 wr32(hw, reg_idx, I40E_VFINT_DYN_CTLN_CLEARPBA_MASK);
551 i40e_flush(hw);
552 }
805bd5bd 553
fc18eaa0
MW		 554 /* clear the irq settings */
555 for (i = 0; i < msix_vf; i++) {
556 /* format is same for both registers */
557 if (0 == i)
558 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id);
559 else
560 reg_idx = I40E_VPINT_LNKLSTN(((msix_vf - 1) *
561 (vf->vf_id))
562 + (i - 1));
563 reg = (I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK |
564 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK);
565 wr32(hw, reg_idx, reg);
566 i40e_flush(hw);
567 }
805bd5bd
MW		 568 /* reset some of the state varibles keeping
569 * track of the resources
570 */
571 vf->num_queue_pairs = 0;
572 vf->vf_states = 0;
573}
574
575/**
576 * i40e_alloc_vf_res
577 * @vf: pointer to the vf info
578 *
579 * allocate vf resources
580 **/
581static int i40e_alloc_vf_res(struct i40e_vf *vf)
582{
583 struct i40e_pf *pf = vf->pf;
584 int total_queue_pairs = 0;
585 int ret;
586
587 /* allocate hw vsi context & associated resources */
588 ret = i40e_alloc_vsi_res(vf, I40E_VSI_SRIOV);
589 if (ret)
590 goto error_alloc;
591 total_queue_pairs += pf->vsi[vf->lan_vsi_index]->num_queue_pairs;
592 set_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps);
593
594 /* store the total qps number for the runtime
595 * vf req validation
596 */
597 vf->num_queue_pairs = total_queue_pairs;
598
599 /* vf is now completely initialized */
600 set_bit(I40E_VF_STAT_INIT, &vf->vf_states);
601
602error_alloc:
603 if (ret)
604 i40e_free_vf_res(vf);
605
606 return ret;
607}
608
fc18eaa0
MW		 609#define VF_DEVICE_STATUS 0xAA
610#define VF_TRANS_PENDING_MASK 0x20
611/**
612 * i40e_quiesce_vf_pci
613 * @vf: pointer to the vf structure
614 *
615 * Wait for VF PCI transactions to be cleared after reset. Returns -EIO
616 * if the transactions never clear.
617 **/
618static int i40e_quiesce_vf_pci(struct i40e_vf *vf)
619{
620 struct i40e_pf *pf = vf->pf;
621 struct i40e_hw *hw = &pf->hw;
622 int vf_abs_id, i;
623 u32 reg;
624
b141d619 625 vf_abs_id = vf->vf_id + hw->func_caps.vf_base_id;
fc18eaa0
MW		 626
627 wr32(hw, I40E_PF_PCI_CIAA,
628 VF_DEVICE_STATUS | (vf_abs_id << I40E_PF_PCI_CIAA_VF_NUM_SHIFT));
629 for (i = 0; i < 100; i++) {
630 reg = rd32(hw, I40E_PF_PCI_CIAD);
631 if ((reg & VF_TRANS_PENDING_MASK) == 0)
632 return 0;
633 udelay(1);
634 }
635 return -EIO;
636}
637
5c3c48ac
JB		 638/**
639 * i40e_reset_vf
640 * @vf: pointer to the vf structure
641 * @flr: VFLR was issued or not
642 *
643 * reset the vf
644 **/
fc18eaa0 645void i40e_reset_vf(struct i40e_vf *vf, bool flr)
5c3c48ac 646{
5c3c48ac
JB		 647 struct i40e_pf *pf = vf->pf;
648 struct i40e_hw *hw = &pf->hw;
5c3c48ac 649 bool rsd = false;
fc18eaa0
MW		 650 int i;
651 u32 reg;
5c3c48ac
JB		 652
653 /* warn the VF */
5c3c48ac
JB		 654 clear_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states);
655
fc18eaa0
MW		 656 /* In the case of a VFLR, the HW has already reset the VF and we
657 * just need to clean up, so don't hit the VFRTRIG register.
5c3c48ac
JB		 658 */
659 if (!flr) {
660 /* reset vf using VPGEN_VFRTRIG reg */
fc18eaa0
MW		 661 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id));
662 reg |= I40E_VPGEN_VFRTRIG_VFSWR_MASK;
5c3c48ac
JB		 663 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg);
664 i40e_flush(hw);
665 }
666
fc18eaa0
MW		 667 if (i40e_quiesce_vf_pci(vf))
668 dev_err(&pf->pdev->dev, "VF %d PCI transactions stuck\n",
669 vf->vf_id);
670
5c3c48ac
JB		 671 /* poll VPGEN_VFRSTAT reg to make sure
672 * that reset is complete
673 */
fc18eaa0 674 for (i = 0; i < 100; i++) {
5c3c48ac
JB		 675 /* vf reset requires driver to first reset the
676 * vf & than poll the status register to make sure
677 * that the requested op was completed
678 * successfully
679 */
680 udelay(10);
681 reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id));
682 if (reg & I40E_VPGEN_VFRSTAT_VFRD_MASK) {
683 rsd = true;
684 break;
685 }
686 }
687
688 if (!rsd)
fc18eaa0 689 dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n",
5c3c48ac 690 vf->vf_id);
fc18eaa0 691 wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), I40E_VFR_COMPLETED);
5c3c48ac
JB		 692 /* clear the reset bit in the VPGEN_VFRTRIG reg */
693 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id));
694 reg &= ~I40E_VPGEN_VFRTRIG_VFSWR_MASK;
695 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg);
fc18eaa0
MW		 696
697 /* On initial reset, we won't have any queues */
698 if (vf->lan_vsi_index == 0)
699 goto complete_reset;
700
701 i40e_vsi_control_rings(pf->vsi[vf->lan_vsi_index], false);
702complete_reset:
703 /* reallocate vf resources to reset the VSI state */
704 i40e_free_vf_res(vf);
fc18eaa0
MW		 705 i40e_alloc_vf_res(vf);
706 i40e_enable_vf_mappings(vf);
c17b362b 707 set_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states);
fc18eaa0 708
5c3c48ac 709 /* tell the VF the reset is done */
fc18eaa0 710 wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), I40E_VFR_VFACTIVE);
5c3c48ac 711 i40e_flush(hw);
5c3c48ac
JB		 712}
713
5c3c48ac
JB		 714/**
715 * i40e_vfs_are_assigned
716 * @pf: pointer to the pf structure
717 *
718 * Determine if any VFs are assigned to VMs
719 **/
720static bool i40e_vfs_are_assigned(struct i40e_pf *pf)
721{
722 struct pci_dev *pdev = pf->pdev;
723 struct pci_dev *vfdev;
724
725 /* loop through all the VFs to see if we own any that are assigned */
ab60085e 726 vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, I40E_DEV_ID_VF , NULL);
5c3c48ac
JB		 727 while (vfdev) {
728 /* if we don't own it we don't care */
729 if (vfdev->is_virtfn && pci_physfn(vfdev) == pdev) {
730 /* if it is assigned we cannot release it */
731 if (vfdev->dev_flags & PCI_DEV_FLAGS_ASSIGNED)
732 return true;
733 }
734
735 vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
ab60085e 736 I40E_DEV_ID_VF,
5c3c48ac
JB		 737 vfdev);
738 }
739
740 return false;
741}
c354229f
GR		 742#ifdef CONFIG_PCI_IOV
743
744/**
745 * i40e_enable_pf_switch_lb
746 * @pf: pointer to the pf structure
747 *
748 * enable switch loop back or die - no point in a return value
749 **/
750static void i40e_enable_pf_switch_lb(struct i40e_pf *pf)
751{
752 struct i40e_vsi *vsi = pf->vsi[pf->lan_vsi];
753 struct i40e_vsi_context ctxt;
754 int aq_ret;
755
756 ctxt.seid = pf->main_vsi_seid;
757 ctxt.pf_num = pf->hw.pf_id;
758 ctxt.vf_num = 0;
759 aq_ret = i40e_aq_get_vsi_params(&pf->hw, &ctxt, NULL);
760 if (aq_ret) {
761 dev_info(&pf->pdev->dev,
762 "%s couldn't get pf vsi config, err %d, aq_err %d\n",
763 __func__, aq_ret, pf->hw.aq.asq_last_status);
764 return;
765 }
766 ctxt.flags = I40E_AQ_VSI_TYPE_PF;
767 ctxt.info.valid_sections = cpu_to_le16(I40E_AQ_VSI_PROP_SWITCH_VALID);
768 ctxt.info.switch_id |= cpu_to_le16(I40E_AQ_VSI_SW_ID_FLAG_ALLOW_LB);
769
770 aq_ret = i40e_aq_update_vsi_params(&vsi->back->hw, &ctxt, NULL);
771 if (aq_ret) {
772 dev_info(&pf->pdev->dev,
773 "%s: update vsi switch failed, aq_err=%d\n",
774 __func__, vsi->back->hw.aq.asq_last_status);
775 }
776}
777#endif
778
779/**
780 * i40e_disable_pf_switch_lb
781 * @pf: pointer to the pf structure
782 *
783 * disable switch loop back or die - no point in a return value
784 **/
785static void i40e_disable_pf_switch_lb(struct i40e_pf *pf)
786{
787 struct i40e_vsi *vsi = pf->vsi[pf->lan_vsi];
788 struct i40e_vsi_context ctxt;
789 int aq_ret;
790
791 ctxt.seid = pf->main_vsi_seid;
792 ctxt.pf_num = pf->hw.pf_id;
793 ctxt.vf_num = 0;
794 aq_ret = i40e_aq_get_vsi_params(&pf->hw, &ctxt, NULL);
795 if (aq_ret) {
796 dev_info(&pf->pdev->dev,
797 "%s couldn't get pf vsi config, err %d, aq_err %d\n",
798 __func__, aq_ret, pf->hw.aq.asq_last_status);
799 return;
800 }
801 ctxt.flags = I40E_AQ_VSI_TYPE_PF;
802 ctxt.info.valid_sections = cpu_to_le16(I40E_AQ_VSI_PROP_SWITCH_VALID);
803 ctxt.info.switch_id &= ~cpu_to_le16(I40E_AQ_VSI_SW_ID_FLAG_ALLOW_LB);
804
805 aq_ret = i40e_aq_update_vsi_params(&vsi->back->hw, &ctxt, NULL);
806 if (aq_ret) {
807 dev_info(&pf->pdev->dev,
808 "%s: update vsi switch failed, aq_err=%d\n",
809 __func__, vsi->back->hw.aq.asq_last_status);
810 }
811}
5c3c48ac
JB		 812
813/**
814 * i40e_free_vfs
815 * @pf: pointer to the pf structure
816 *
817 * free vf resources
818 **/
819void i40e_free_vfs(struct i40e_pf *pf)
820{
f7414531
MW		 821 struct i40e_hw *hw = &pf->hw;
822 u32 reg_idx, bit_idx;
823 int i, tmp, vf_id;
5c3c48ac
JB		 824
825 if (!pf->vf)
826 return;
827
828 /* Disable interrupt 0 so we don't try to handle the VFLR. */
2ef28cfb
MW		 829 i40e_irq_dynamic_disable_icr0(pf);
830
6c1b5bff 831 mdelay(10); /* let any messages in transit get finished up */
5c3c48ac 832 /* free up vf resources */
6c1b5bff
MW		 833 tmp = pf->num_alloc_vfs;
834 pf->num_alloc_vfs = 0;
835 for (i = 0; i < tmp; i++) {
5c3c48ac
JB		 836 if (test_bit(I40E_VF_STAT_INIT, &pf->vf[i].vf_states))
837 i40e_free_vf_res(&pf->vf[i]);
838 /* disable qp mappings */
839 i40e_disable_vf_mappings(&pf->vf[i]);
840 }
841
842 kfree(pf->vf);
843 pf->vf = NULL;
5c3c48ac 844
9e5634df
MW		 845 /* This check is for when the driver is unloaded while VFs are
846 * assigned. Setting the number of VFs to 0 through sysfs is caught
847 * before this function ever gets called.
848 */
f7414531 849 if (!i40e_vfs_are_assigned(pf)) {
5c3c48ac 850 pci_disable_sriov(pf->pdev);
f7414531
MW		 851 /* Acknowledge VFLR for all VFS. Without this, VFs will fail to
852 * work correctly when SR-IOV gets re-enabled.
853 */
854 for (vf_id = 0; vf_id < tmp; vf_id++) {
855 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32;
856 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32;
857 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), (1 << bit_idx));
858 }
c354229f
GR		 859 i40e_disable_pf_switch_lb(pf);
860 } else {
5c3c48ac
JB		 861 dev_warn(&pf->pdev->dev,
862 "unable to disable SR-IOV because VFs are assigned.\n");
c354229f 863 }
5c3c48ac
JB		 864
865 /* Re-enable interrupt 0. */
2ef28cfb 866 i40e_irq_dynamic_enable_icr0(pf);
5c3c48ac
JB		 867}
868
869#ifdef CONFIG_PCI_IOV
870/**
871 * i40e_alloc_vfs
872 * @pf: pointer to the pf structure
873 * @num_alloc_vfs: number of vfs to allocate
874 *
875 * allocate vf resources
876 **/
4aeec010 877int i40e_alloc_vfs(struct i40e_pf *pf, u16 num_alloc_vfs)
5c3c48ac
JB		 878{
879 struct i40e_vf *vfs;
880 int i, ret = 0;
881
6c1b5bff 882 /* Disable interrupt 0 so we don't try to handle the VFLR. */
2ef28cfb
MW		 883 i40e_irq_dynamic_disable_icr0(pf);
884
4aeec010
MW		 885 /* Check to see if we're just allocating resources for extant VFs */
886 if (pci_num_vf(pf->pdev) != num_alloc_vfs) {
887 ret = pci_enable_sriov(pf->pdev, num_alloc_vfs);
888 if (ret) {
889 dev_err(&pf->pdev->dev,
890 "Failed to enable SR-IOV, error %d.\n", ret);
891 pf->num_alloc_vfs = 0;
892 goto err_iov;
893 }
5c3c48ac 894 }
5c3c48ac 895 /* allocate memory */
cc6456af 896 vfs = kcalloc(num_alloc_vfs, sizeof(struct i40e_vf), GFP_KERNEL);
5c3c48ac
JB		 897 if (!vfs) {
898 ret = -ENOMEM;
899 goto err_alloc;
900 }
901
902 /* apply default profile */
903 for (i = 0; i < num_alloc_vfs; i++) {
904 vfs[i].pf = pf;
905 vfs[i].parent_type = I40E_SWITCH_ELEMENT_TYPE_VEB;
906 vfs[i].vf_id = i;
907
908 /* assign default capabilities */
909 set_bit(I40E_VIRTCHNL_VF_CAP_L2, &vfs[i].vf_caps);
fc18eaa0
MW		 910 /* vf resources get allocated during reset */
911 i40e_reset_vf(&vfs[i], false);
5c3c48ac
JB		 912
913 /* enable vf vplan_qtable mappings */
914 i40e_enable_vf_mappings(&vfs[i]);
915 }
916 pf->vf = vfs;
917 pf->num_alloc_vfs = num_alloc_vfs;
918
c354229f 919 i40e_enable_pf_switch_lb(pf);
5c3c48ac
JB		 920err_alloc:
921 if (ret)
922 i40e_free_vfs(pf);
923err_iov:
6c1b5bff 924 /* Re-enable interrupt 0. */
2ef28cfb 925 i40e_irq_dynamic_enable_icr0(pf);
5c3c48ac
JB		 926 return ret;
927}
928
929#endif
930/**
931 * i40e_pci_sriov_enable
932 * @pdev: pointer to a pci_dev structure
933 * @num_vfs: number of vfs to allocate
934 *
935 * Enable or change the number of VFs
936 **/
937static int i40e_pci_sriov_enable(struct pci_dev *pdev, int num_vfs)
938{
939#ifdef CONFIG_PCI_IOV
940 struct i40e_pf *pf = pci_get_drvdata(pdev);
941 int pre_existing_vfs = pci_num_vf(pdev);
942 int err = 0;
943
944 dev_info(&pdev->dev, "Allocating %d VFs.\n", num_vfs);
945 if (pre_existing_vfs && pre_existing_vfs != num_vfs)
946 i40e_free_vfs(pf);
947 else if (pre_existing_vfs && pre_existing_vfs == num_vfs)
948 goto out;
949
950 if (num_vfs > pf->num_req_vfs) {
951 err = -EPERM;
952 goto err_out;
953 }
954
955 err = i40e_alloc_vfs(pf, num_vfs);
956 if (err) {
957 dev_warn(&pdev->dev, "Failed to enable SR-IOV: %d\n", err);
958 goto err_out;
959 }
960
961out:
962 return num_vfs;
963
964err_out:
965 return err;
966#endif
967 return 0;
968}
969
970/**
971 * i40e_pci_sriov_configure
972 * @pdev: pointer to a pci_dev structure
973 * @num_vfs: number of vfs to allocate
974 *
975 * Enable or change the number of VFs. Called when the user updates the number
976 * of VFs in sysfs.
977 **/
978int i40e_pci_sriov_configure(struct pci_dev *pdev, int num_vfs)
979{
980 struct i40e_pf *pf = pci_get_drvdata(pdev);
981
982 if (num_vfs)
983 return i40e_pci_sriov_enable(pdev, num_vfs);
984
9e5634df
MW		 985 if (!i40e_vfs_are_assigned(pf)) {
986 i40e_free_vfs(pf);
987 } else {
988 dev_warn(&pdev->dev, "Unable to free VFs because some are assigned to VMs.\n");
989 return -EINVAL;
990 }
5c3c48ac
JB		 991 return 0;
992}
993
994/***********************virtual channel routines******************/
995
996/**
997 * i40e_vc_send_msg_to_vf
998 * @vf: pointer to the vf info
999 * @v_opcode: virtual channel opcode
1000 * @v_retval: virtual channel return value
1001 * @msg: pointer to the msg buffer
1002 * @msglen: msg length
1003 *
1004 * send msg to vf
1005 **/
1006static int i40e_vc_send_msg_to_vf(struct i40e_vf *vf, u32 v_opcode,
1007 u32 v_retval, u8 *msg, u16 msglen)
1008{
1009 struct i40e_pf *pf = vf->pf;
1010 struct i40e_hw *hw = &pf->hw;
7efa84b7 1011 int true_vf_id = vf->vf_id + hw->func_caps.vf_base_id;
5c3c48ac
JB		 1012 i40e_status aq_ret;
1013
1014 /* single place to detect unsuccessful return values */
1015 if (v_retval) {
1016 vf->num_invalid_msgs++;
1017 dev_err(&pf->pdev->dev, "Failed opcode %d Error: %d\n",
1018 v_opcode, v_retval);
1019 if (vf->num_invalid_msgs >
1020 I40E_DEFAULT_NUM_INVALID_MSGS_ALLOWED) {
1021 dev_err(&pf->pdev->dev,
1022 "Number of invalid messages exceeded for VF %d\n",
1023 vf->vf_id);
1024 dev_err(&pf->pdev->dev, "Use PF Control I/F to enable the VF\n");
1025 set_bit(I40E_VF_STAT_DISABLED, &vf->vf_states);
1026 }
1027 } else {
1028 vf->num_valid_msgs++;
1029 }
1030
7efa84b7
MW		 1031 aq_ret = i40e_aq_send_msg_to_vf(hw, true_vf_id, v_opcode, v_retval,
1032 msg, msglen, NULL);
5c3c48ac
JB		 1033 if (aq_ret) {
1034 dev_err(&pf->pdev->dev,
1035 "Unable to send the message to VF %d aq_err %d\n",
1036 vf->vf_id, pf->hw.aq.asq_last_status);
1037 return -EIO;
1038 }
1039
1040 return 0;
1041}
1042
1043/**
1044 * i40e_vc_send_resp_to_vf
1045 * @vf: pointer to the vf info
1046 * @opcode: operation code
1047 * @retval: return value
1048 *
1049 * send resp msg to vf
1050 **/
1051static int i40e_vc_send_resp_to_vf(struct i40e_vf *vf,
1052 enum i40e_virtchnl_ops opcode,
1053 i40e_status retval)
1054{
1055 return i40e_vc_send_msg_to_vf(vf, opcode, retval, NULL, 0);
1056}
1057
1058/**
1059 * i40e_vc_get_version_msg
1060 * @vf: pointer to the vf info
1061 *
1062 * called from the vf to request the API version used by the PF
1063 **/
1064static int i40e_vc_get_version_msg(struct i40e_vf *vf)
1065{
1066 struct i40e_virtchnl_version_info info = {
1067 I40E_VIRTCHNL_VERSION_MAJOR, I40E_VIRTCHNL_VERSION_MINOR
1068 };
1069
1070 return i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_VERSION,
1071 I40E_SUCCESS, (u8 *)&info,
1072 sizeof(struct
1073 i40e_virtchnl_version_info));
1074}
1075
1076/**
1077 * i40e_vc_get_vf_resources_msg
1078 * @vf: pointer to the vf info
1079 * @msg: pointer to the msg buffer
1080 * @msglen: msg length
1081 *
1082 * called from the vf to request its resources
1083 **/
1084static int i40e_vc_get_vf_resources_msg(struct i40e_vf *vf)
1085{
1086 struct i40e_virtchnl_vf_resource *vfres = NULL;
1087 struct i40e_pf *pf = vf->pf;
1088 i40e_status aq_ret = 0;
1089 struct i40e_vsi *vsi;
1090 int i = 0, len = 0;
1091 int num_vsis = 1;
1092 int ret;
1093
1094 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) {
1095 aq_ret = I40E_ERR_PARAM;
1096 goto err;
1097 }
1098
1099 len = (sizeof(struct i40e_virtchnl_vf_resource) +
1100 sizeof(struct i40e_virtchnl_vsi_resource) * num_vsis);
1101
1102 vfres = kzalloc(len, GFP_KERNEL);
1103 if (!vfres) {
1104 aq_ret = I40E_ERR_NO_MEMORY;
1105 len = 0;
1106 goto err;
1107 }
1108
1109 vfres->vf_offload_flags = I40E_VIRTCHNL_VF_OFFLOAD_L2;
1110 vsi = pf->vsi[vf->lan_vsi_index];
1111 if (!vsi->info.pvid)
1112 vfres->vf_offload_flags |= I40E_VIRTCHNL_VF_OFFLOAD_VLAN;
1113
1114 vfres->num_vsis = num_vsis;
1115 vfres->num_queue_pairs = vf->num_queue_pairs;
1116 vfres->max_vectors = pf->hw.func_caps.num_msix_vectors_vf;
1117 if (vf->lan_vsi_index) {
1118 vfres->vsi_res[i].vsi_id = vf->lan_vsi_index;
1119 vfres->vsi_res[i].vsi_type = I40E_VSI_SRIOV;
1120 vfres->vsi_res[i].num_queue_pairs =
1121 pf->vsi[vf->lan_vsi_index]->num_queue_pairs;
1122 memcpy(vfres->vsi_res[i].default_mac_addr,
1123 vf->default_lan_addr.addr, ETH_ALEN);
1124 i++;
1125 }
1126 set_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states);
1127
1128err:
1129 /* send the response back to the vf */
1130 ret = i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_GET_VF_RESOURCES,
1131 aq_ret, (u8 *)vfres, len);
1132
1133 kfree(vfres);
1134 return ret;
1135}
1136
1137/**
1138 * i40e_vc_reset_vf_msg
1139 * @vf: pointer to the vf info
1140 * @msg: pointer to the msg buffer
1141 * @msglen: msg length
1142 *
1143 * called from the vf to reset itself,
1144 * unlike other virtchnl messages, pf driver
1145 * doesn't send the response back to the vf
1146 **/
fc18eaa0 1147static void i40e_vc_reset_vf_msg(struct i40e_vf *vf)
5c3c48ac 1148{
fc18eaa0
MW		 1149 if (test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states))
1150 i40e_reset_vf(vf, false);
5c3c48ac
JB		 1151}
1152
1153/**
1154 * i40e_vc_config_promiscuous_mode_msg
1155 * @vf: pointer to the vf info
1156 * @msg: pointer to the msg buffer
1157 * @msglen: msg length
1158 *
1159 * called from the vf to configure the promiscuous mode of
1160 * vf vsis
1161 **/
1162static int i40e_vc_config_promiscuous_mode_msg(struct i40e_vf *vf,
1163 u8 *msg, u16 msglen)
1164{
1165 struct i40e_virtchnl_promisc_info *info =
1166 (struct i40e_virtchnl_promisc_info *)msg;
1167 struct i40e_pf *pf = vf->pf;
1168 struct i40e_hw *hw = &pf->hw;
1169 bool allmulti = false;
1170 bool promisc = false;
1171 i40e_status aq_ret;
1172
1173 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) ||
1174 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) ||
1175 !i40e_vc_isvalid_vsi_id(vf, info->vsi_id) ||
1176 (pf->vsi[info->vsi_id]->type != I40E_VSI_FCOE)) {
1177 aq_ret = I40E_ERR_PARAM;
1178 goto error_param;
1179 }
1180
1181 if (info->flags & I40E_FLAG_VF_UNICAST_PROMISC)
1182 promisc = true;
1183 aq_ret = i40e_aq_set_vsi_unicast_promiscuous(hw, info->vsi_id,
1184 promisc, NULL);
1185 if (aq_ret)
1186 goto error_param;
1187
1188 if (info->flags & I40E_FLAG_VF_MULTICAST_PROMISC)
1189 allmulti = true;
1190 aq_ret = i40e_aq_set_vsi_multicast_promiscuous(hw, info->vsi_id,
1191 allmulti, NULL);
1192
1193error_param:
1194 /* send the response to the vf */
1195 return i40e_vc_send_resp_to_vf(vf,
1196 I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
1197 aq_ret);
1198}
1199
1200/**
1201 * i40e_vc_config_queues_msg
1202 * @vf: pointer to the vf info
1203 * @msg: pointer to the msg buffer
1204 * @msglen: msg length
1205 *
1206 * called from the vf to configure the rx/tx
1207 * queues
1208 **/
1209static int i40e_vc_config_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1210{
1211 struct i40e_virtchnl_vsi_queue_config_info *qci =
1212 (struct i40e_virtchnl_vsi_queue_config_info *)msg;
1213 struct i40e_virtchnl_queue_pair_info *qpi;
1214 u16 vsi_id, vsi_queue_id;
1215 i40e_status aq_ret = 0;
1216 int i;
1217
1218 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) {
1219 aq_ret = I40E_ERR_PARAM;
1220 goto error_param;
1221 }
1222
1223 vsi_id = qci->vsi_id;
1224 if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
1225 aq_ret = I40E_ERR_PARAM;
1226 goto error_param;
1227 }
1228 for (i = 0; i < qci->num_queue_pairs; i++) {
1229 qpi = &qci->qpair[i];
1230 vsi_queue_id = qpi->txq.queue_id;
1231 if ((qpi->txq.vsi_id != vsi_id) ||
1232 (qpi->rxq.vsi_id != vsi_id) ||
1233 (qpi->rxq.queue_id != vsi_queue_id) ||
1234 !i40e_vc_isvalid_queue_id(vf, vsi_id, vsi_queue_id)) {
1235 aq_ret = I40E_ERR_PARAM;
1236 goto error_param;
1237 }
1238
1239 if (i40e_config_vsi_rx_queue(vf, vsi_id, vsi_queue_id,
1240 &qpi->rxq) ||
1241 i40e_config_vsi_tx_queue(vf, vsi_id, vsi_queue_id,
1242 &qpi->txq)) {
1243 aq_ret = I40E_ERR_PARAM;
1244 goto error_param;
1245 }
1246 }
1247
1248error_param:
1249 /* send the response to the vf */
1250 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES,
1251 aq_ret);
1252}
1253
1254/**
1255 * i40e_vc_config_irq_map_msg
1256 * @vf: pointer to the vf info
1257 * @msg: pointer to the msg buffer
1258 * @msglen: msg length
1259 *
1260 * called from the vf to configure the irq to
1261 * queue map
1262 **/
1263static int i40e_vc_config_irq_map_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1264{
1265 struct i40e_virtchnl_irq_map_info *irqmap_info =
1266 (struct i40e_virtchnl_irq_map_info *)msg;
1267 struct i40e_virtchnl_vector_map *map;
1268 u16 vsi_id, vsi_queue_id, vector_id;
1269 i40e_status aq_ret = 0;
1270 unsigned long tempmap;
1271 int i;
1272
1273 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) {
1274 aq_ret = I40E_ERR_PARAM;
1275 goto error_param;
1276 }
1277
1278 for (i = 0; i < irqmap_info->num_vectors; i++) {
1279 map = &irqmap_info->vecmap[i];
1280
1281 vector_id = map->vector_id;
1282 vsi_id = map->vsi_id;
1283 /* validate msg params */
1284 if (!i40e_vc_isvalid_vector_id(vf, vector_id) ||
1285 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
1286 aq_ret = I40E_ERR_PARAM;
1287 goto error_param;
1288 }
1289
1290 /* lookout for the invalid queue index */
1291 tempmap = map->rxq_map;
4836650b 1292 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
5c3c48ac
JB		 1293 if (!i40e_vc_isvalid_queue_id(vf, vsi_id,
1294 vsi_queue_id)) {
1295 aq_ret = I40E_ERR_PARAM;
1296 goto error_param;
1297 }
5c3c48ac
JB		 1298 }
1299
1300 tempmap = map->txq_map;
4836650b 1301 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
5c3c48ac
JB		 1302 if (!i40e_vc_isvalid_queue_id(vf, vsi_id,
1303 vsi_queue_id)) {
1304 aq_ret = I40E_ERR_PARAM;
1305 goto error_param;
1306 }
5c3c48ac
JB		 1307 }
1308
1309 i40e_config_irq_link_list(vf, vsi_id, map);
1310 }
1311error_param:
1312 /* send the response to the vf */
1313 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP,
1314 aq_ret);
1315}
1316
1317/**
1318 * i40e_vc_enable_queues_msg
1319 * @vf: pointer to the vf info
1320 * @msg: pointer to the msg buffer
1321 * @msglen: msg length
1322 *
1323 * called from the vf to enable all or specific queue(s)
1324 **/
1325static int i40e_vc_enable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1326{
1327 struct i40e_virtchnl_queue_select *vqs =
1328 (struct i40e_virtchnl_queue_select *)msg;
1329 struct i40e_pf *pf = vf->pf;
1330 u16 vsi_id = vqs->vsi_id;
1331 i40e_status aq_ret = 0;
5c3c48ac
JB		 1332
1333 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) {
1334 aq_ret = I40E_ERR_PARAM;
1335 goto error_param;
1336 }
1337
1338 if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
1339 aq_ret = I40E_ERR_PARAM;
1340 goto error_param;
1341 }
1342
1343 if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) {
1344 aq_ret = I40E_ERR_PARAM;
1345 goto error_param;
1346 }
88f6563d
MW		 1347 if (i40e_vsi_control_rings(pf->vsi[vsi_id], true))
1348 aq_ret = I40E_ERR_TIMEOUT;
5c3c48ac
JB		 1349error_param:
1350 /* send the response to the vf */
1351 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ENABLE_QUEUES,
1352 aq_ret);
1353}
1354
1355/**
1356 * i40e_vc_disable_queues_msg
1357 * @vf: pointer to the vf info
1358 * @msg: pointer to the msg buffer
1359 * @msglen: msg length
1360 *
1361 * called from the vf to disable all or specific
1362 * queue(s)
1363 **/
1364static int i40e_vc_disable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1365{
1366 struct i40e_virtchnl_queue_select *vqs =
1367 (struct i40e_virtchnl_queue_select *)msg;
1368 struct i40e_pf *pf = vf->pf;
1369 u16 vsi_id = vqs->vsi_id;
1370 i40e_status aq_ret = 0;
5c3c48ac
JB		 1371
1372 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) {
1373 aq_ret = I40E_ERR_PARAM;
1374 goto error_param;
1375 }
1376
1377 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
1378 aq_ret = I40E_ERR_PARAM;
1379 goto error_param;
1380 }
1381
1382 if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) {
1383 aq_ret = I40E_ERR_PARAM;
1384 goto error_param;
1385 }
88f6563d
MW		 1386 if (i40e_vsi_control_rings(pf->vsi[vsi_id], false))
1387 aq_ret = I40E_ERR_TIMEOUT;
5c3c48ac
JB		 1388
1389error_param:
1390 /* send the response to the vf */
1391 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DISABLE_QUEUES,
1392 aq_ret);
1393}
1394
1395/**
1396 * i40e_vc_get_stats_msg
1397 * @vf: pointer to the vf info
1398 * @msg: pointer to the msg buffer
1399 * @msglen: msg length
1400 *
1401 * called from the vf to get vsi stats
1402 **/
1403static int i40e_vc_get_stats_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1404{
1405 struct i40e_virtchnl_queue_select *vqs =
1406 (struct i40e_virtchnl_queue_select *)msg;
1407 struct i40e_pf *pf = vf->pf;
1408 struct i40e_eth_stats stats;
1409 i40e_status aq_ret = 0;
1410 struct i40e_vsi *vsi;
1411
1412 memset(&stats, 0, sizeof(struct i40e_eth_stats));
1413
1414 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) {
1415 aq_ret = I40E_ERR_PARAM;
1416 goto error_param;
1417 }
1418
1419 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
1420 aq_ret = I40E_ERR_PARAM;
1421 goto error_param;
1422 }
1423
1424 vsi = pf->vsi[vqs->vsi_id];
1425 if (!vsi) {
1426 aq_ret = I40E_ERR_PARAM;
1427 goto error_param;
1428 }
1429 i40e_update_eth_stats(vsi);
5a9769c8 1430 stats = vsi->eth_stats;
5c3c48ac
JB		 1431
1432error_param:
1433 /* send the response back to the vf */
1434 return i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_GET_STATS, aq_ret,
1435 (u8 *)&stats, sizeof(stats));
1436}
1437
f657a6e1
GR		 1438/**
1439 * i40e_check_vf_permission
1440 * @vf: pointer to the vf info
1441 * @macaddr: pointer to the MAC Address being checked
1442 *
1443 * Check if the VF has permission to add or delete unicast MAC address
1444 * filters and return error code -EPERM if not. Then check if the
1445 * address filter requested is broadcast or zero and if so return
1446 * an invalid MAC address error code.
1447 **/
1448static inline int i40e_check_vf_permission(struct i40e_vf *vf, u8 *macaddr)
1449{
1450 struct i40e_pf *pf = vf->pf;
1451 int ret = 0;
1452
1453 if (is_broadcast_ether_addr(macaddr) ||
1454 is_zero_ether_addr(macaddr)) {
1455 dev_err(&pf->pdev->dev, "invalid VF MAC addr %pM\n", macaddr);
1456 ret = I40E_ERR_INVALID_MAC_ADDR;
5017c2a8
GR		 1457 } else if (vf->pf_set_mac && !is_multicast_ether_addr(macaddr) &&
1458 !ether_addr_equal(macaddr, vf->default_lan_addr.addr)) {
f657a6e1
GR		 1459 /* If the host VMM administrator has set the VF MAC address
1460 * administratively via the ndo_set_vf_mac command then deny
1461 * permission to the VF to add or delete unicast MAC addresses.
5017c2a8
GR		 1462 * The VF may request to set the MAC address filter already
1463 * assigned to it so do not return an error in that case.
f657a6e1
GR		 1464 */
1465 dev_err(&pf->pdev->dev,
1466 "VF attempting to override administratively set MAC address\nPlease reload the VF driver to resume normal operation\n");
1467 ret = -EPERM;
1468 }
1469 return ret;
1470}
1471
5c3c48ac
JB		 1472/**
1473 * i40e_vc_add_mac_addr_msg
1474 * @vf: pointer to the vf info
1475 * @msg: pointer to the msg buffer
1476 * @msglen: msg length
1477 *
1478 * add guest mac address filter
1479 **/
1480static int i40e_vc_add_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1481{
1482 struct i40e_virtchnl_ether_addr_list *al =
1483 (struct i40e_virtchnl_ether_addr_list *)msg;
1484 struct i40e_pf *pf = vf->pf;
1485 struct i40e_vsi *vsi = NULL;
1486 u16 vsi_id = al->vsi_id;
f657a6e1 1487 i40e_status ret = 0;
5c3c48ac
JB		 1488 int i;
1489
1490 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) ||
1491 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) ||
1492 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
f657a6e1 1493 ret = I40E_ERR_PARAM;
5c3c48ac
JB		 1494 goto error_param;
1495 }
1496
1497 for (i = 0; i < al->num_elements; i++) {
f657a6e1
GR		 1498 ret = i40e_check_vf_permission(vf, al->list[i].addr);
1499 if (ret)
5c3c48ac 1500 goto error_param;
5c3c48ac
JB		 1501 }
1502 vsi = pf->vsi[vsi_id];
1503
1504 /* add new addresses to the list */
1505 for (i = 0; i < al->num_elements; i++) {
1506 struct i40e_mac_filter *f;
1507
1508 f = i40e_find_mac(vsi, al->list[i].addr, true, false);
7e68edf9 1509 if (!f) {
5c3c48ac
JB		 1510 if (i40e_is_vsi_in_vlan(vsi))
1511 f = i40e_put_mac_in_vlan(vsi, al->list[i].addr,
1512 true, false);
1513 else
1514 f = i40e_add_filter(vsi, al->list[i].addr, -1,
1515 true, false);
1516 }
1517
1518 if (!f) {
1519 dev_err(&pf->pdev->dev,
1520 "Unable to add VF MAC filter\n");
f657a6e1 1521 ret = I40E_ERR_PARAM;
5c3c48ac
JB		 1522 goto error_param;
1523 }
1524 }
1525
1526 /* program the updated filter list */
1527 if (i40e_sync_vsi_filters(vsi))
1528 dev_err(&pf->pdev->dev, "Unable to program VF MAC filters\n");
1529
1530error_param:
1531 /* send the response to the vf */
1532 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS,
f657a6e1 1533 ret);
5c3c48ac
JB		 1534}
1535
1536/**
1537 * i40e_vc_del_mac_addr_msg
1538 * @vf: pointer to the vf info
1539 * @msg: pointer to the msg buffer
1540 * @msglen: msg length
1541 *
1542 * remove guest mac address filter
1543 **/
1544static int i40e_vc_del_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1545{
1546 struct i40e_virtchnl_ether_addr_list *al =
1547 (struct i40e_virtchnl_ether_addr_list *)msg;
1548 struct i40e_pf *pf = vf->pf;
1549 struct i40e_vsi *vsi = NULL;
1550 u16 vsi_id = al->vsi_id;
f657a6e1 1551 i40e_status ret = 0;
5c3c48ac
JB		 1552 int i;
1553
1554 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) ||
1555 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) ||
1556 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
f657a6e1 1557 ret = I40E_ERR_PARAM;
5c3c48ac
JB		 1558 goto error_param;
1559 }
f657a6e1
GR		 1560
1561 for (i = 0; i < al->num_elements; i++) {
700bbf6c
MW		 1562 if (is_broadcast_ether_addr(al->list[i].addr) ||
1563 is_zero_ether_addr(al->list[i].addr)) {
1564 dev_err(&pf->pdev->dev, "invalid VF MAC addr %pM\n",
1565 al->list[i].addr);
1566 ret = I40E_ERR_INVALID_MAC_ADDR;
f657a6e1 1567 goto error_param;
700bbf6c 1568 }
f657a6e1 1569 }
5c3c48ac
JB		 1570 vsi = pf->vsi[vsi_id];
1571
1572 /* delete addresses from the list */
1573 for (i = 0; i < al->num_elements; i++)
1574 i40e_del_filter(vsi, al->list[i].addr,
1575 I40E_VLAN_ANY, true, false);
1576
1577 /* program the updated filter list */
1578 if (i40e_sync_vsi_filters(vsi))
1579 dev_err(&pf->pdev->dev, "Unable to program VF MAC filters\n");
1580
1581error_param:
1582 /* send the response to the vf */
1583 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS,
f657a6e1 1584 ret);
5c3c48ac
JB		 1585}
1586
1587/**
1588 * i40e_vc_add_vlan_msg
1589 * @vf: pointer to the vf info
1590 * @msg: pointer to the msg buffer
1591 * @msglen: msg length
1592 *
1593 * program guest vlan id
1594 **/
1595static int i40e_vc_add_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1596{
1597 struct i40e_virtchnl_vlan_filter_list *vfl =
1598 (struct i40e_virtchnl_vlan_filter_list *)msg;
1599 struct i40e_pf *pf = vf->pf;
1600 struct i40e_vsi *vsi = NULL;
1601 u16 vsi_id = vfl->vsi_id;
1602 i40e_status aq_ret = 0;
1603 int i;
1604
1605 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) ||
1606 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) ||
1607 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
1608 aq_ret = I40E_ERR_PARAM;
1609 goto error_param;
1610 }
1611
1612 for (i = 0; i < vfl->num_elements; i++) {
1613 if (vfl->vlan_id[i] > I40E_MAX_VLANID) {
1614 aq_ret = I40E_ERR_PARAM;
1615 dev_err(&pf->pdev->dev,
1616 "invalid VF VLAN id %d\n", vfl->vlan_id[i]);
1617 goto error_param;
1618 }
1619 }
1620 vsi = pf->vsi[vsi_id];
1621 if (vsi->info.pvid) {
1622 aq_ret = I40E_ERR_PARAM;
1623 goto error_param;
1624 }
1625
1626 i40e_vlan_stripping_enable(vsi);
1627 for (i = 0; i < vfl->num_elements; i++) {
1628 /* add new VLAN filter */
1629 int ret = i40e_vsi_add_vlan(vsi, vfl->vlan_id[i]);
1630 if (ret)
1631 dev_err(&pf->pdev->dev,
1632 "Unable to add VF vlan filter %d, error %d\n",
1633 vfl->vlan_id[i], ret);
1634 }
1635
1636error_param:
1637 /* send the response to the vf */
1638 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ADD_VLAN, aq_ret);
1639}
1640
1641/**
1642 * i40e_vc_remove_vlan_msg
1643 * @vf: pointer to the vf info
1644 * @msg: pointer to the msg buffer
1645 * @msglen: msg length
1646 *
1647 * remove programmed guest vlan id
1648 **/
1649static int i40e_vc_remove_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
1650{
1651 struct i40e_virtchnl_vlan_filter_list *vfl =
1652 (struct i40e_virtchnl_vlan_filter_list *)msg;
1653 struct i40e_pf *pf = vf->pf;
1654 struct i40e_vsi *vsi = NULL;
1655 u16 vsi_id = vfl->vsi_id;
1656 i40e_status aq_ret = 0;
1657 int i;
1658
1659 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) ||
1660 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) ||
1661 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
1662 aq_ret = I40E_ERR_PARAM;
1663 goto error_param;
1664 }
1665
1666 for (i = 0; i < vfl->num_elements; i++) {
1667 if (vfl->vlan_id[i] > I40E_MAX_VLANID) {
1668 aq_ret = I40E_ERR_PARAM;
1669 goto error_param;
1670 }
1671 }
1672
1673 vsi = pf->vsi[vsi_id];
1674 if (vsi->info.pvid) {
1675 aq_ret = I40E_ERR_PARAM;
1676 goto error_param;
1677 }
1678
1679 for (i = 0; i < vfl->num_elements; i++) {
1680 int ret = i40e_vsi_kill_vlan(vsi, vfl->vlan_id[i]);
1681 if (ret)
1682 dev_err(&pf->pdev->dev,
1683 "Unable to delete VF vlan filter %d, error %d\n",
1684 vfl->vlan_id[i], ret);
1685 }
1686
1687error_param:
1688 /* send the response to the vf */
1689 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DEL_VLAN, aq_ret);
1690}
1691
5c3c48ac
JB		 1692/**
1693 * i40e_vc_validate_vf_msg
1694 * @vf: pointer to the vf info
1695 * @msg: pointer to the msg buffer
1696 * @msglen: msg length
1697 * @msghndl: msg handle
1698 *
1699 * validate msg
1700 **/
1701static int i40e_vc_validate_vf_msg(struct i40e_vf *vf, u32 v_opcode,
1702 u32 v_retval, u8 *msg, u16 msglen)
1703{
1704 bool err_msg_format = false;
1705 int valid_len;
1706
1707 /* Check if VF is disabled. */
1708 if (test_bit(I40E_VF_STAT_DISABLED, &vf->vf_states))
1709 return I40E_ERR_PARAM;
1710
1711 /* Validate message length. */
1712 switch (v_opcode) {
1713 case I40E_VIRTCHNL_OP_VERSION:
1714 valid_len = sizeof(struct i40e_virtchnl_version_info);
1715 break;
1716 case I40E_VIRTCHNL_OP_RESET_VF:
1717 case I40E_VIRTCHNL_OP_GET_VF_RESOURCES:
1718 valid_len = 0;
1719 break;
1720 case I40E_VIRTCHNL_OP_CONFIG_TX_QUEUE:
1721 valid_len = sizeof(struct i40e_virtchnl_txq_info);
1722 break;
1723 case I40E_VIRTCHNL_OP_CONFIG_RX_QUEUE:
1724 valid_len = sizeof(struct i40e_virtchnl_rxq_info);
1725 break;
1726 case I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES:
1727 valid_len = sizeof(struct i40e_virtchnl_vsi_queue_config_info);
1728 if (msglen >= valid_len) {
1729 struct i40e_virtchnl_vsi_queue_config_info *vqc =
1730 (struct i40e_virtchnl_vsi_queue_config_info *)msg;
1731 valid_len += (vqc->num_queue_pairs *
1732 sizeof(struct
1733 i40e_virtchnl_queue_pair_info));
1734 if (vqc->num_queue_pairs == 0)
1735 err_msg_format = true;
1736 }
1737 break;
1738 case I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP:
1739 valid_len = sizeof(struct i40e_virtchnl_irq_map_info);
1740 if (msglen >= valid_len) {
1741 struct i40e_virtchnl_irq_map_info *vimi =
1742 (struct i40e_virtchnl_irq_map_info *)msg;
1743 valid_len += (vimi->num_vectors *
1744 sizeof(struct i40e_virtchnl_vector_map));
1745 if (vimi->num_vectors == 0)
1746 err_msg_format = true;
1747 }
1748 break;
1749 case I40E_VIRTCHNL_OP_ENABLE_QUEUES:
1750 case I40E_VIRTCHNL_OP_DISABLE_QUEUES:
1751 valid_len = sizeof(struct i40e_virtchnl_queue_select);
1752 break;
1753 case I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS:
1754 case I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS:
1755 valid_len = sizeof(struct i40e_virtchnl_ether_addr_list);
1756 if (msglen >= valid_len) {
1757 struct i40e_virtchnl_ether_addr_list *veal =
1758 (struct i40e_virtchnl_ether_addr_list *)msg;
1759 valid_len += veal->num_elements *
1760 sizeof(struct i40e_virtchnl_ether_addr);
1761 if (veal->num_elements == 0)
1762 err_msg_format = true;
1763 }
1764 break;
1765 case I40E_VIRTCHNL_OP_ADD_VLAN:
1766 case I40E_VIRTCHNL_OP_DEL_VLAN:
1767 valid_len = sizeof(struct i40e_virtchnl_vlan_filter_list);
1768 if (msglen >= valid_len) {
1769 struct i40e_virtchnl_vlan_filter_list *vfl =
1770 (struct i40e_virtchnl_vlan_filter_list *)msg;
1771 valid_len += vfl->num_elements * sizeof(u16);
1772 if (vfl->num_elements == 0)
1773 err_msg_format = true;
1774 }
1775 break;
1776 case I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE:
1777 valid_len = sizeof(struct i40e_virtchnl_promisc_info);
1778 break;
1779 case I40E_VIRTCHNL_OP_GET_STATS:
1780 valid_len = sizeof(struct i40e_virtchnl_queue_select);
1781 break;
1782 /* These are always errors coming from the VF. */
1783 case I40E_VIRTCHNL_OP_EVENT:
1784 case I40E_VIRTCHNL_OP_UNKNOWN:
1785 default:
1786 return -EPERM;
1787 break;
1788 }
1789 /* few more checks */
1790 if ((valid_len != msglen) || (err_msg_format)) {
1791 i40e_vc_send_resp_to_vf(vf, v_opcode, I40E_ERR_PARAM);
1792 return -EINVAL;
1793 } else {
1794 return 0;
1795 }
1796}
1797
1798/**
1799 * i40e_vc_process_vf_msg
1800 * @pf: pointer to the pf structure
1801 * @vf_id: source vf id
1802 * @msg: pointer to the msg buffer
1803 * @msglen: msg length
1804 * @msghndl: msg handle
1805 *
1806 * called from the common aeq/arq handler to
1807 * process request from vf
1808 **/
1809int i40e_vc_process_vf_msg(struct i40e_pf *pf, u16 vf_id, u32 v_opcode,
1810 u32 v_retval, u8 *msg, u16 msglen)
1811{
5c3c48ac 1812 struct i40e_hw *hw = &pf->hw;
c243e963 1813 unsigned int local_vf_id = vf_id - hw->func_caps.vf_base_id;
6c1b5bff 1814 struct i40e_vf *vf;
5c3c48ac
JB		 1815 int ret;
1816
1817 pf->vf_aq_requests++;
7efa84b7 1818 if (local_vf_id >= pf->num_alloc_vfs)
6c1b5bff 1819 return -EINVAL;
7efa84b7 1820 vf = &(pf->vf[local_vf_id]);
5c3c48ac
JB		 1821 /* perform basic checks on the msg */
1822 ret = i40e_vc_validate_vf_msg(vf, v_opcode, v_retval, msg, msglen);
1823
1824 if (ret) {
499ec80f 1825 dev_err(&pf->pdev->dev, "Invalid message from vf %d, opcode %d, len %d\n",
7efa84b7 1826 local_vf_id, v_opcode, msglen);
5c3c48ac
JB		 1827 return ret;
1828 }
bae3cae4 1829
5c3c48ac
JB		 1830 switch (v_opcode) {
1831 case I40E_VIRTCHNL_OP_VERSION:
1832 ret = i40e_vc_get_version_msg(vf);
1833 break;
1834 case I40E_VIRTCHNL_OP_GET_VF_RESOURCES:
1835 ret = i40e_vc_get_vf_resources_msg(vf);
1836 break;
1837 case I40E_VIRTCHNL_OP_RESET_VF:
fc18eaa0
MW		 1838 i40e_vc_reset_vf_msg(vf);
1839 ret = 0;
5c3c48ac
JB		 1840 break;
1841 case I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE:
1842 ret = i40e_vc_config_promiscuous_mode_msg(vf, msg, msglen);
1843 break;
1844 case I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES:
1845 ret = i40e_vc_config_queues_msg(vf, msg, msglen);
1846 break;
1847 case I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP:
1848 ret = i40e_vc_config_irq_map_msg(vf, msg, msglen);
1849 break;
1850 case I40E_VIRTCHNL_OP_ENABLE_QUEUES:
1851 ret = i40e_vc_enable_queues_msg(vf, msg, msglen);
1852 break;
1853 case I40E_VIRTCHNL_OP_DISABLE_QUEUES:
1854 ret = i40e_vc_disable_queues_msg(vf, msg, msglen);
1855 break;
1856 case I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS:
1857 ret = i40e_vc_add_mac_addr_msg(vf, msg, msglen);
1858 break;
1859 case I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS:
1860 ret = i40e_vc_del_mac_addr_msg(vf, msg, msglen);
1861 break;
1862 case I40E_VIRTCHNL_OP_ADD_VLAN:
1863 ret = i40e_vc_add_vlan_msg(vf, msg, msglen);
1864 break;
1865 case I40E_VIRTCHNL_OP_DEL_VLAN:
1866 ret = i40e_vc_remove_vlan_msg(vf, msg, msglen);
1867 break;
1868 case I40E_VIRTCHNL_OP_GET_STATS:
1869 ret = i40e_vc_get_stats_msg(vf, msg, msglen);
1870 break;
5c3c48ac
JB		 1871 case I40E_VIRTCHNL_OP_UNKNOWN:
1872 default:
7efa84b7
MW		 1873 dev_err(&pf->pdev->dev, "Unsupported opcode %d from vf %d\n",
1874 v_opcode, local_vf_id);
5c3c48ac
JB		 1875 ret = i40e_vc_send_resp_to_vf(vf, v_opcode,
1876 I40E_ERR_NOT_IMPLEMENTED);
1877 break;
1878 }
1879
1880 return ret;
1881}
1882
1883/**
1884 * i40e_vc_process_vflr_event
1885 * @pf: pointer to the pf structure
1886 *
1887 * called from the vlfr irq handler to
1888 * free up vf resources and state variables
1889 **/
1890int i40e_vc_process_vflr_event(struct i40e_pf *pf)
1891{
1892 u32 reg, reg_idx, bit_idx, vf_id;
1893 struct i40e_hw *hw = &pf->hw;
1894 struct i40e_vf *vf;
1895
1896 if (!test_bit(__I40E_VFLR_EVENT_PENDING, &pf->state))
1897 return 0;
1898
1899 clear_bit(__I40E_VFLR_EVENT_PENDING, &pf->state);
1900 for (vf_id = 0; vf_id < pf->num_alloc_vfs; vf_id++) {
1901 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32;
1902 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32;
1903 /* read GLGEN_VFLRSTAT register to find out the flr vfs */
1904 vf = &pf->vf[vf_id];
1905 reg = rd32(hw, I40E_GLGEN_VFLRSTAT(reg_idx));
1906 if (reg & (1 << bit_idx)) {
1907 /* clear the bit in GLGEN_VFLRSTAT */
1908 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), (1 << bit_idx));
1909
eb2d80bc
MW		 1910 if (!test_bit(__I40E_DOWN, &pf->state))
1911 i40e_reset_vf(vf, true);
5c3c48ac
JB		 1912 }
1913 }
1914
1915 /* re-enable vflr interrupt cause */
1916 reg = rd32(hw, I40E_PFINT_ICR0_ENA);
1917 reg |= I40E_PFINT_ICR0_ENA_VFLR_MASK;
1918 wr32(hw, I40E_PFINT_ICR0_ENA, reg);
1919 i40e_flush(hw);
1920
1921 return 0;
1922}
1923
1924/**
1925 * i40e_vc_vf_broadcast
1926 * @pf: pointer to the pf structure
1927 * @opcode: operation code
1928 * @retval: return value
1929 * @msg: pointer to the msg buffer
1930 * @msglen: msg length
1931 *
1932 * send a message to all VFs on a given PF
1933 **/
1934static void i40e_vc_vf_broadcast(struct i40e_pf *pf,
1935 enum i40e_virtchnl_ops v_opcode,
1936 i40e_status v_retval, u8 *msg,
1937 u16 msglen)
1938{
1939 struct i40e_hw *hw = &pf->hw;
1940 struct i40e_vf *vf = pf->vf;
1941 int i;
1942
1943 for (i = 0; i < pf->num_alloc_vfs; i++) {
1944 /* Ignore return value on purpose - a given VF may fail, but
1945 * we need to keep going and send to all of them
1946 */
1947 i40e_aq_send_msg_to_vf(hw, vf->vf_id, v_opcode, v_retval,
1948 msg, msglen, NULL);
1949 vf++;
1950 }
1951}
1952
1953/**
1954 * i40e_vc_notify_link_state
1955 * @pf: pointer to the pf structure
1956 *
1957 * send a link status message to all VFs on a given PF
1958 **/
1959void i40e_vc_notify_link_state(struct i40e_pf *pf)
1960{
1961 struct i40e_virtchnl_pf_event pfe;
588aefa0
MW		 1962 struct i40e_hw *hw = &pf->hw;
1963 struct i40e_vf *vf = pf->vf;
1964 struct i40e_link_status *ls = &pf->hw.phy.link_info;
1965 int i;
5c3c48ac
JB		 1966
1967 pfe.event = I40E_VIRTCHNL_EVENT_LINK_CHANGE;
1968 pfe.severity = I40E_PF_EVENT_SEVERITY_INFO;
588aefa0
MW		 1969 for (i = 0; i < pf->num_alloc_vfs; i++) {
1970 if (vf->link_forced) {
1971 pfe.event_data.link_event.link_status = vf->link_up;
1972 pfe.event_data.link_event.link_speed =
1973 (vf->link_up ? I40E_LINK_SPEED_40GB : 0);
1974 } else {
1975 pfe.event_data.link_event.link_status =
1976 ls->link_info & I40E_AQ_LINK_UP;
1977 pfe.event_data.link_event.link_speed = ls->link_speed;
1978 }
1979 i40e_aq_send_msg_to_vf(hw, vf->vf_id, I40E_VIRTCHNL_OP_EVENT,
1980 0, (u8 *)&pfe, sizeof(pfe),
1981 NULL);
1982 vf++;
1983 }
5c3c48ac
JB		 1984}
1985
1986/**
1987 * i40e_vc_notify_reset
1988 * @pf: pointer to the pf structure
1989 *
1990 * indicate a pending reset to all VFs on a given PF
1991 **/
1992void i40e_vc_notify_reset(struct i40e_pf *pf)
1993{
1994 struct i40e_virtchnl_pf_event pfe;
1995
1996 pfe.event = I40E_VIRTCHNL_EVENT_RESET_IMPENDING;
1997 pfe.severity = I40E_PF_EVENT_SEVERITY_CERTAIN_DOOM;
1998 i40e_vc_vf_broadcast(pf, I40E_VIRTCHNL_OP_EVENT, I40E_SUCCESS,
1999 (u8 *)&pfe, sizeof(struct i40e_virtchnl_pf_event));
2000}
2001
2002/**
2003 * i40e_vc_notify_vf_reset
2004 * @vf: pointer to the vf structure
2005 *
2006 * indicate a pending reset to the given VF
2007 **/
2008void i40e_vc_notify_vf_reset(struct i40e_vf *vf)
2009{
2010 struct i40e_virtchnl_pf_event pfe;
2011
2012 pfe.event = I40E_VIRTCHNL_EVENT_RESET_IMPENDING;
2013 pfe.severity = I40E_PF_EVENT_SEVERITY_CERTAIN_DOOM;
2014 i40e_aq_send_msg_to_vf(&vf->pf->hw, vf->vf_id, I40E_VIRTCHNL_OP_EVENT,
2015 I40E_SUCCESS, (u8 *)&pfe,
2016 sizeof(struct i40e_virtchnl_pf_event), NULL);
2017}
2018
2019/**
2020 * i40e_ndo_set_vf_mac
2021 * @netdev: network interface device structure
2022 * @vf_id: vf identifier
2023 * @mac: mac address
2024 *
2025 * program vf mac address
2026 **/
2027int i40e_ndo_set_vf_mac(struct net_device *netdev, int vf_id, u8 *mac)
2028{
2029 struct i40e_netdev_priv *np = netdev_priv(netdev);
2030 struct i40e_vsi *vsi = np->vsi;
2031 struct i40e_pf *pf = vsi->back;
2032 struct i40e_mac_filter *f;
2033 struct i40e_vf *vf;
2034 int ret = 0;
2035
2036 /* validate the request */
2037 if (vf_id >= pf->num_alloc_vfs) {
2038 dev_err(&pf->pdev->dev,
2039 "Invalid VF Identifier %d\n", vf_id);
2040 ret = -EINVAL;
2041 goto error_param;
2042 }
2043
2044 vf = &(pf->vf[vf_id]);
2045 vsi = pf->vsi[vf->lan_vsi_index];
2046 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) {
2047 dev_err(&pf->pdev->dev,
2048 "Uninitialized VF %d\n", vf_id);
2049 ret = -EINVAL;
2050 goto error_param;
2051 }
2052
2053 if (!is_valid_ether_addr(mac)) {
2054 dev_err(&pf->pdev->dev,
2055 "Invalid VF ethernet address\n");
2056 ret = -EINVAL;
2057 goto error_param;
2058 }
2059
2060 /* delete the temporary mac address */
37cc0d2f
GR		 2061 i40e_del_filter(vsi, vf->default_lan_addr.addr, vf->port_vlan_id,
2062 true, false);
5c3c48ac
JB		 2063
2064 /* add the new mac address */
37cc0d2f 2065 f = i40e_add_filter(vsi, mac, vf->port_vlan_id, true, false);
5c3c48ac
JB		 2066 if (!f) {
2067 dev_err(&pf->pdev->dev,
2068 "Unable to add VF ucast filter\n");
2069 ret = -ENOMEM;
2070 goto error_param;
2071 }
2072
2073 dev_info(&pf->pdev->dev, "Setting MAC %pM on VF %d\n", mac, vf_id);
2074 /* program mac filter */
2075 if (i40e_sync_vsi_filters(vsi)) {
2076 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n");
2077 ret = -EIO;
2078 goto error_param;
2079 }
2080 memcpy(vf->default_lan_addr.addr, mac, ETH_ALEN);
f657a6e1 2081 vf->pf_set_mac = true;
5c3c48ac
JB		 2082 dev_info(&pf->pdev->dev, "Reload the VF driver to make this change effective.\n");
2083 ret = 0;
2084
2085error_param:
2086 return ret;
2087}
2088
2089/**
2090 * i40e_ndo_set_vf_port_vlan
2091 * @netdev: network interface device structure
2092 * @vf_id: vf identifier
2093 * @vlan_id: mac address
2094 * @qos: priority setting
2095 *
2096 * program vf vlan id and/or qos
2097 **/
2098int i40e_ndo_set_vf_port_vlan(struct net_device *netdev,
2099 int vf_id, u16 vlan_id, u8 qos)
2100{
2101 struct i40e_netdev_priv *np = netdev_priv(netdev);
2102 struct i40e_pf *pf = np->vsi->back;
2103 struct i40e_vsi *vsi;
2104 struct i40e_vf *vf;
2105 int ret = 0;
2106
2107 /* validate the request */
2108 if (vf_id >= pf->num_alloc_vfs) {
2109 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
2110 ret = -EINVAL;
2111 goto error_pvid;
2112 }
2113
2114 if ((vlan_id > I40E_MAX_VLANID) || (qos > 7)) {
2115 dev_err(&pf->pdev->dev, "Invalid VF Parameters\n");
2116 ret = -EINVAL;
2117 goto error_pvid;
2118 }
2119
2120 vf = &(pf->vf[vf_id]);
2121 vsi = pf->vsi[vf->lan_vsi_index];
2122 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) {
2123 dev_err(&pf->pdev->dev, "Uninitialized VF %d\n", vf_id);
2124 ret = -EINVAL;
2125 goto error_pvid;
2126 }
2127
f9b4b627 2128 if (vsi->info.pvid == 0 && i40e_is_vsi_in_vlan(vsi)) {
99a4973c
GR		 2129 dev_err(&pf->pdev->dev,
2130 "VF %d has already configured VLAN filters and the administrator is requesting a port VLAN override.\nPlease unload and reload the VF driver for this change to take effect.\n",
2131 vf_id);
f9b4b627
GR		 2132 /* Administrator Error - knock the VF offline until he does
2133 * the right thing by reconfiguring his network correctly
2134 * and then reloading the VF driver.
2135 */
2136 i40e_vc_disable_vf(pf, vf);
2137 }
99a4973c 2138
8d82a7c5
GR		 2139 /* Check for condition where there was already a port VLAN ID
2140 * filter set and now it is being deleted by setting it to zero.
1315f7c3
GR		 2141 * Additionally check for the condition where there was a port
2142 * VLAN but now there is a new and different port VLAN being set.
8d82a7c5
GR		 2143 * Before deleting all the old VLAN filters we must add new ones
2144 * with -1 (I40E_VLAN_ANY) or otherwise we're left with all our
2145 * MAC addresses deleted.
2146 */
1315f7c3
GR		 2147 if ((!(vlan_id || qos) ||
2148 (vlan_id | qos) != le16_to_cpu(vsi->info.pvid)) &&
2149 vsi->info.pvid)
8d82a7c5
GR		 2150 ret = i40e_vsi_add_vlan(vsi, I40E_VLAN_ANY);
2151
5c3c48ac
JB		 2152 if (vsi->info.pvid) {
2153 /* kill old VLAN */
2154 ret = i40e_vsi_kill_vlan(vsi, (le16_to_cpu(vsi->info.pvid) &
2155 VLAN_VID_MASK));
2156 if (ret) {
2157 dev_info(&vsi->back->pdev->dev,
2158 "remove VLAN failed, ret=%d, aq_err=%d\n",
2159 ret, pf->hw.aq.asq_last_status);
2160 }
2161 }
2162 if (vlan_id || qos)
2163 ret = i40e_vsi_add_pvid(vsi,
2164 vlan_id | (qos << I40E_VLAN_PRIORITY_SHIFT));
2165 else
6c12fcbf 2166 i40e_vsi_remove_pvid(vsi);
5c3c48ac
JB		 2167
2168 if (vlan_id) {
2169 dev_info(&pf->pdev->dev, "Setting VLAN %d, QOS 0x%x on VF %d\n",
2170 vlan_id, qos, vf_id);
2171
2172 /* add new VLAN filter */
2173 ret = i40e_vsi_add_vlan(vsi, vlan_id);
2174 if (ret) {
2175 dev_info(&vsi->back->pdev->dev,
2176 "add VF VLAN failed, ret=%d aq_err=%d\n", ret,
2177 vsi->back->hw.aq.asq_last_status);
2178 goto error_pvid;
2179 }
8d82a7c5
GR		 2180 /* Kill non-vlan MAC filters - ignore error return since
2181 * there might not be any non-vlan MAC filters.
2182 */
2183 i40e_vsi_kill_vlan(vsi, I40E_VLAN_ANY);
5c3c48ac
JB		 2184 }
2185
2186 if (ret) {
2187 dev_err(&pf->pdev->dev, "Unable to update VF vsi context\n");
2188 goto error_pvid;
2189 }
6c12fcbf
GR		 2190 /* The Port VLAN needs to be saved across resets the same as the
2191 * default LAN MAC address.
2192 */
2193 vf->port_vlan_id = le16_to_cpu(vsi->info.pvid);
5c3c48ac
JB		 2194 ret = 0;
2195
2196error_pvid:
2197 return ret;
2198}
2199
2200/**
2201 * i40e_ndo_set_vf_bw
2202 * @netdev: network interface device structure
2203 * @vf_id: vf identifier
2204 * @tx_rate: tx rate
2205 *
2206 * configure vf tx rate
2207 **/
2208int i40e_ndo_set_vf_bw(struct net_device *netdev, int vf_id, int tx_rate)
2209{
6b192891
MW		 2210 struct i40e_netdev_priv *np = netdev_priv(netdev);
2211 struct i40e_pf *pf = np->vsi->back;
2212 struct i40e_vsi *vsi;
2213 struct i40e_vf *vf;
2214 int speed = 0;
2215 int ret = 0;
2216
2217 /* validate the request */
2218 if (vf_id >= pf->num_alloc_vfs) {
2219 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d.\n", vf_id);
2220 ret = -EINVAL;
2221 goto error;
2222 }
2223
2224 vf = &(pf->vf[vf_id]);
2225 vsi = pf->vsi[vf->lan_vsi_index];
2226 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) {
2227 dev_err(&pf->pdev->dev, "Uninitialized VF %d.\n", vf_id);
2228 ret = -EINVAL;
2229 goto error;
2230 }
2231
2232 switch (pf->hw.phy.link_info.link_speed) {
2233 case I40E_LINK_SPEED_40GB:
2234 speed = 40000;
2235 break;
2236 case I40E_LINK_SPEED_10GB:
2237 speed = 10000;
2238 break;
2239 case I40E_LINK_SPEED_1GB:
2240 speed = 1000;
2241 break;
2242 default:
2243 break;
2244 }
2245
2246 if (tx_rate > speed) {
2247 dev_err(&pf->pdev->dev, "Invalid tx rate %d specified for vf %d.",
2248 tx_rate, vf->vf_id);
2249 ret = -EINVAL;
2250 goto error;
2251 }
2252
2253 /* Tx rate credits are in values of 50Mbps, 0 is disabled*/
2254 ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid, tx_rate / 50, 0,
2255 NULL);
2256 if (ret) {
2257 dev_err(&pf->pdev->dev, "Unable to set tx rate, error code %d.\n",
2258 ret);
2259 ret = -EIO;
2260 goto error;
2261 }
2262 vf->tx_rate = tx_rate;
2263error:
2264 return ret;
5c3c48ac
JB		 2265}
2266
2267/**
2268 * i40e_ndo_get_vf_config
2269 * @netdev: network interface device structure
2270 * @vf_id: vf identifier
2271 * @ivi: vf configuration structure
2272 *
2273 * return vf configuration
2274 **/
2275int i40e_ndo_get_vf_config(struct net_device *netdev,
2276 int vf_id, struct ifla_vf_info *ivi)
2277{
2278 struct i40e_netdev_priv *np = netdev_priv(netdev);
5c3c48ac
JB		 2279 struct i40e_vsi *vsi = np->vsi;
2280 struct i40e_pf *pf = vsi->back;
2281 struct i40e_vf *vf;
2282 int ret = 0;
2283
2284 /* validate the request */
2285 if (vf_id >= pf->num_alloc_vfs) {
2286 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
2287 ret = -EINVAL;
2288 goto error_param;
2289 }
2290
2291 vf = &(pf->vf[vf_id]);
2292 /* first vsi is always the LAN vsi */
2293 vsi = pf->vsi[vf->lan_vsi_index];
2294 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) {
2295 dev_err(&pf->pdev->dev, "Uninitialized VF %d\n", vf_id);
2296 ret = -EINVAL;
2297 goto error_param;
2298 }
2299
2300 ivi->vf = vf_id;
2301
f4a1c5cf 2302 memcpy(&ivi->mac, vf->default_lan_addr.addr, ETH_ALEN);
5c3c48ac 2303
6b192891 2304 ivi->tx_rate = vf->tx_rate;
5c3c48ac
JB		 2305 ivi->vlan = le16_to_cpu(vsi->info.pvid) & I40E_VLAN_MASK;
2306 ivi->qos = (le16_to_cpu(vsi->info.pvid) & I40E_PRIORITY_MASK) >>
2307 I40E_VLAN_PRIORITY_SHIFT;
84ca55a0
MW		 2308 if (vf->link_forced == false)
2309 ivi->linkstate = IFLA_VF_LINK_STATE_AUTO;
2310 else if (vf->link_up == true)
2311 ivi->linkstate = IFLA_VF_LINK_STATE_ENABLE;
2312 else
2313 ivi->linkstate = IFLA_VF_LINK_STATE_DISABLE;
2314
5c3c48ac
JB		 2315 ret = 0;
2316
2317error_param:
2318 return ret;
2319}
588aefa0
MW		 2320
2321/**
2322 * i40e_ndo_set_vf_link_state
2323 * @netdev: network interface device structure
2324 * @vf_id: vf identifier
2325 * @link: required link state
2326 *
2327 * Set the link state of a specified VF, regardless of physical link state
2328 **/
2329int i40e_ndo_set_vf_link_state(struct net_device *netdev, int vf_id, int link)
2330{
2331 struct i40e_netdev_priv *np = netdev_priv(netdev);
2332 struct i40e_pf *pf = np->vsi->back;
2333 struct i40e_virtchnl_pf_event pfe;
2334 struct i40e_hw *hw = &pf->hw;
2335 struct i40e_vf *vf;
2336 int ret = 0;
2337
2338 /* validate the request */
2339 if (vf_id >= pf->num_alloc_vfs) {
2340 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
2341 ret = -EINVAL;
2342 goto error_out;
2343 }
2344
2345 vf = &pf->vf[vf_id];
2346
2347 pfe.event = I40E_VIRTCHNL_EVENT_LINK_CHANGE;
2348 pfe.severity = I40E_PF_EVENT_SEVERITY_INFO;
2349
2350 switch (link) {
2351 case IFLA_VF_LINK_STATE_AUTO:
2352 vf->link_forced = false;
2353 pfe.event_data.link_event.link_status =
2354 pf->hw.phy.link_info.link_info & I40E_AQ_LINK_UP;
2355 pfe.event_data.link_event.link_speed =
2356 pf->hw.phy.link_info.link_speed;
2357 break;
2358 case IFLA_VF_LINK_STATE_ENABLE:
2359 vf->link_forced = true;
2360 vf->link_up = true;
2361 pfe.event_data.link_event.link_status = true;
2362 pfe.event_data.link_event.link_speed = I40E_LINK_SPEED_40GB;
2363 break;
2364 case IFLA_VF_LINK_STATE_DISABLE:
2365 vf->link_forced = true;
2366 vf->link_up = false;
2367 pfe.event_data.link_event.link_status = false;
2368 pfe.event_data.link_event.link_speed = 0;
2369 break;
2370 default:
2371 ret = -EINVAL;
2372 goto error_out;
2373 }
2374 /* Notify the VF of its new link state */
2375 i40e_aq_send_msg_to_vf(hw, vf->vf_id, I40E_VIRTCHNL_OP_EVENT,
2376 0, (u8 *)&pfe, sizeof(pfe), NULL);
2377
2378error_out:
2379 return ret;
2380}
Linux 6.x block layer and io_uring tree(s)