1 /******************************************************************************* 2 * 3 * Intel Ethernet Controller XL710 Family Linux Driver 4 * Copyright(c) 2013 - 2016 Intel Corporation. 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 * 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/>. 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 /*********************notification routines***********************/ 30 31 /** 32 * i40e_vc_vf_broadcast 33 * @pf: pointer to the PF structure 34 * @opcode: operation code 35 * @retval: return value 36 * @msg: pointer to the msg buffer 37 * @msglen: msg length 38 * 39 * send a message to all VFs on a given PF 40 **/ 41 static void i40e_vc_vf_broadcast(struct i40e_pf *pf, 42 enum i40e_virtchnl_ops v_opcode, 43 i40e_status v_retval, u8 *msg, 44 u16 msglen) 45 { 46 struct i40e_hw *hw = &pf->hw; 47 struct i40e_vf *vf = pf->vf; 48 int i; 49 50 for (i = 0; i < pf->num_alloc_vfs; i++, vf++) { 51 int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id; 52 /* Not all vfs are enabled so skip the ones that are not */ 53 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states) && 54 !test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) 55 continue; 56 57 /* Ignore return value on purpose - a given VF may fail, but 58 * we need to keep going and send to all of them 59 */ 60 i40e_aq_send_msg_to_vf(hw, abs_vf_id, v_opcode, v_retval, 61 msg, msglen, NULL); 62 } 63 } 64 65 /** 66 * i40e_vc_notify_vf_link_state 67 * @vf: pointer to the VF structure 68 * 69 * send a link status message to a single VF 70 **/ 71 static void i40e_vc_notify_vf_link_state(struct i40e_vf *vf) 72 { 73 struct i40e_virtchnl_pf_event pfe; 74 struct i40e_pf *pf = vf->pf; 75 struct i40e_hw *hw = &pf->hw; 76 struct i40e_link_status *ls = &pf->hw.phy.link_info; 77 int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id; 78 79 pfe.event = I40E_VIRTCHNL_EVENT_LINK_CHANGE; 80 pfe.severity = I40E_PF_EVENT_SEVERITY_INFO; 81 if (vf->link_forced) { 82 pfe.event_data.link_event.link_status = vf->link_up; 83 pfe.event_data.link_event.link_speed = 84 (vf->link_up ? I40E_LINK_SPEED_40GB : 0); 85 } else { 86 pfe.event_data.link_event.link_status = 87 ls->link_info & I40E_AQ_LINK_UP; 88 pfe.event_data.link_event.link_speed = ls->link_speed; 89 } 90 i40e_aq_send_msg_to_vf(hw, abs_vf_id, I40E_VIRTCHNL_OP_EVENT, 91 0, (u8 *)&pfe, sizeof(pfe), NULL); 92 } 93 94 /** 95 * i40e_vc_notify_link_state 96 * @pf: pointer to the PF structure 97 * 98 * send a link status message to all VFs on a given PF 99 **/ 100 void i40e_vc_notify_link_state(struct i40e_pf *pf) 101 { 102 int i; 103 104 for (i = 0; i < pf->num_alloc_vfs; i++) 105 i40e_vc_notify_vf_link_state(&pf->vf[i]); 106 } 107 108 /** 109 * i40e_vc_notify_reset 110 * @pf: pointer to the PF structure 111 * 112 * indicate a pending reset to all VFs on a given PF 113 **/ 114 void i40e_vc_notify_reset(struct i40e_pf *pf) 115 { 116 struct i40e_virtchnl_pf_event pfe; 117 118 pfe.event = I40E_VIRTCHNL_EVENT_RESET_IMPENDING; 119 pfe.severity = I40E_PF_EVENT_SEVERITY_CERTAIN_DOOM; 120 i40e_vc_vf_broadcast(pf, I40E_VIRTCHNL_OP_EVENT, 0, 121 (u8 *)&pfe, sizeof(struct i40e_virtchnl_pf_event)); 122 } 123 124 /** 125 * i40e_vc_notify_vf_reset 126 * @vf: pointer to the VF structure 127 * 128 * indicate a pending reset to the given VF 129 **/ 130 void i40e_vc_notify_vf_reset(struct i40e_vf *vf) 131 { 132 struct i40e_virtchnl_pf_event pfe; 133 int abs_vf_id; 134 135 /* validate the request */ 136 if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs) 137 return; 138 139 /* verify if the VF is in either init or active before proceeding */ 140 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states) && 141 !test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) 142 return; 143 144 abs_vf_id = vf->vf_id + (int)vf->pf->hw.func_caps.vf_base_id; 145 146 pfe.event = I40E_VIRTCHNL_EVENT_RESET_IMPENDING; 147 pfe.severity = I40E_PF_EVENT_SEVERITY_CERTAIN_DOOM; 148 i40e_aq_send_msg_to_vf(&vf->pf->hw, abs_vf_id, I40E_VIRTCHNL_OP_EVENT, 149 0, (u8 *)&pfe, 150 sizeof(struct i40e_virtchnl_pf_event), NULL); 151 } 152 /***********************misc routines*****************************/ 153 154 /** 155 * i40e_vc_disable_vf 156 * @pf: pointer to the PF info 157 * @vf: pointer to the VF info 158 * 159 * Disable the VF through a SW reset 160 **/ 161 static inline void i40e_vc_disable_vf(struct i40e_pf *pf, struct i40e_vf *vf) 162 { 163 i40e_vc_notify_vf_reset(vf); 164 i40e_reset_vf(vf, false); 165 } 166 167 /** 168 * i40e_vc_isvalid_vsi_id 169 * @vf: pointer to the VF info 170 * @vsi_id: VF relative VSI id 171 * 172 * check for the valid VSI id 173 **/ 174 static inline bool i40e_vc_isvalid_vsi_id(struct i40e_vf *vf, u16 vsi_id) 175 { 176 struct i40e_pf *pf = vf->pf; 177 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 178 179 return (vsi && (vsi->vf_id == vf->vf_id)); 180 } 181 182 /** 183 * i40e_vc_isvalid_queue_id 184 * @vf: pointer to the VF info 185 * @vsi_id: vsi id 186 * @qid: vsi relative queue id 187 * 188 * check for the valid queue id 189 **/ 190 static inline bool i40e_vc_isvalid_queue_id(struct i40e_vf *vf, u16 vsi_id, 191 u8 qid) 192 { 193 struct i40e_pf *pf = vf->pf; 194 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 195 196 return (vsi && (qid < vsi->alloc_queue_pairs)); 197 } 198 199 /** 200 * i40e_vc_isvalid_vector_id 201 * @vf: pointer to the VF info 202 * @vector_id: VF relative vector id 203 * 204 * check for the valid vector id 205 **/ 206 static inline bool i40e_vc_isvalid_vector_id(struct i40e_vf *vf, u8 vector_id) 207 { 208 struct i40e_pf *pf = vf->pf; 209 210 return vector_id < pf->hw.func_caps.num_msix_vectors_vf; 211 } 212 213 /***********************vf resource mgmt routines*****************/ 214 215 /** 216 * i40e_vc_get_pf_queue_id 217 * @vf: pointer to the VF info 218 * @vsi_id: id of VSI as provided by the FW 219 * @vsi_queue_id: vsi relative queue id 220 * 221 * return PF relative queue id 222 **/ 223 static u16 i40e_vc_get_pf_queue_id(struct i40e_vf *vf, u16 vsi_id, 224 u8 vsi_queue_id) 225 { 226 struct i40e_pf *pf = vf->pf; 227 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 228 u16 pf_queue_id = I40E_QUEUE_END_OF_LIST; 229 230 if (!vsi) 231 return pf_queue_id; 232 233 if (le16_to_cpu(vsi->info.mapping_flags) & 234 I40E_AQ_VSI_QUE_MAP_NONCONTIG) 235 pf_queue_id = 236 le16_to_cpu(vsi->info.queue_mapping[vsi_queue_id]); 237 else 238 pf_queue_id = le16_to_cpu(vsi->info.queue_mapping[0]) + 239 vsi_queue_id; 240 241 return pf_queue_id; 242 } 243 244 /** 245 * i40e_config_irq_link_list 246 * @vf: pointer to the VF info 247 * @vsi_id: id of VSI as given by the FW 248 * @vecmap: irq map info 249 * 250 * configure irq link list from the map 251 **/ 252 static void i40e_config_irq_link_list(struct i40e_vf *vf, u16 vsi_id, 253 struct i40e_virtchnl_vector_map *vecmap) 254 { 255 unsigned long linklistmap = 0, tempmap; 256 struct i40e_pf *pf = vf->pf; 257 struct i40e_hw *hw = &pf->hw; 258 u16 vsi_queue_id, pf_queue_id; 259 enum i40e_queue_type qtype; 260 u16 next_q, vector_id; 261 u32 reg, reg_idx; 262 u16 itr_idx = 0; 263 264 vector_id = vecmap->vector_id; 265 /* setup the head */ 266 if (0 == vector_id) 267 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id); 268 else 269 reg_idx = I40E_VPINT_LNKLSTN( 270 ((pf->hw.func_caps.num_msix_vectors_vf - 1) * vf->vf_id) + 271 (vector_id - 1)); 272 273 if (vecmap->rxq_map == 0 && vecmap->txq_map == 0) { 274 /* Special case - No queues mapped on this vector */ 275 wr32(hw, reg_idx, I40E_VPINT_LNKLST0_FIRSTQ_INDX_MASK); 276 goto irq_list_done; 277 } 278 tempmap = vecmap->rxq_map; 279 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 280 linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES * 281 vsi_queue_id)); 282 } 283 284 tempmap = vecmap->txq_map; 285 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 286 linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES * 287 vsi_queue_id + 1)); 288 } 289 290 next_q = find_first_bit(&linklistmap, 291 (I40E_MAX_VSI_QP * 292 I40E_VIRTCHNL_SUPPORTED_QTYPES)); 293 vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES; 294 qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES; 295 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id); 296 reg = ((qtype << I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT) | pf_queue_id); 297 298 wr32(hw, reg_idx, reg); 299 300 while (next_q < (I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES)) { 301 switch (qtype) { 302 case I40E_QUEUE_TYPE_RX: 303 reg_idx = I40E_QINT_RQCTL(pf_queue_id); 304 itr_idx = vecmap->rxitr_idx; 305 break; 306 case I40E_QUEUE_TYPE_TX: 307 reg_idx = I40E_QINT_TQCTL(pf_queue_id); 308 itr_idx = vecmap->txitr_idx; 309 break; 310 default: 311 break; 312 } 313 314 next_q = find_next_bit(&linklistmap, 315 (I40E_MAX_VSI_QP * 316 I40E_VIRTCHNL_SUPPORTED_QTYPES), 317 next_q + 1); 318 if (next_q < 319 (I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES)) { 320 vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES; 321 qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES; 322 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, 323 vsi_queue_id); 324 } else { 325 pf_queue_id = I40E_QUEUE_END_OF_LIST; 326 qtype = 0; 327 } 328 329 /* format for the RQCTL & TQCTL regs is same */ 330 reg = (vector_id) | 331 (qtype << I40E_QINT_RQCTL_NEXTQ_TYPE_SHIFT) | 332 (pf_queue_id << I40E_QINT_RQCTL_NEXTQ_INDX_SHIFT) | 333 BIT(I40E_QINT_RQCTL_CAUSE_ENA_SHIFT) | 334 (itr_idx << I40E_QINT_RQCTL_ITR_INDX_SHIFT); 335 wr32(hw, reg_idx, reg); 336 } 337 338 /* if the vf is running in polling mode and using interrupt zero, 339 * need to disable auto-mask on enabling zero interrupt for VFs. 340 */ 341 if ((vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_RX_POLLING) && 342 (vector_id == 0)) { 343 reg = rd32(hw, I40E_GLINT_CTL); 344 if (!(reg & I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK)) { 345 reg |= I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK; 346 wr32(hw, I40E_GLINT_CTL, reg); 347 } 348 } 349 350 irq_list_done: 351 i40e_flush(hw); 352 } 353 354 /** 355 * i40e_release_iwarp_qvlist 356 * @vf: pointer to the VF. 357 * 358 **/ 359 static void i40e_release_iwarp_qvlist(struct i40e_vf *vf) 360 { 361 struct i40e_pf *pf = vf->pf; 362 struct i40e_virtchnl_iwarp_qvlist_info *qvlist_info = vf->qvlist_info; 363 u32 msix_vf; 364 u32 i; 365 366 if (!vf->qvlist_info) 367 return; 368 369 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 370 for (i = 0; i < qvlist_info->num_vectors; i++) { 371 struct i40e_virtchnl_iwarp_qv_info *qv_info; 372 u32 next_q_index, next_q_type; 373 struct i40e_hw *hw = &pf->hw; 374 u32 v_idx, reg_idx, reg; 375 376 qv_info = &qvlist_info->qv_info[i]; 377 if (!qv_info) 378 continue; 379 v_idx = qv_info->v_idx; 380 if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) { 381 /* Figure out the queue after CEQ and make that the 382 * first queue. 383 */ 384 reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx; 385 reg = rd32(hw, I40E_VPINT_CEQCTL(reg_idx)); 386 next_q_index = (reg & I40E_VPINT_CEQCTL_NEXTQ_INDX_MASK) 387 >> I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT; 388 next_q_type = (reg & I40E_VPINT_CEQCTL_NEXTQ_TYPE_MASK) 389 >> I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT; 390 391 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 392 reg = (next_q_index & 393 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) | 394 (next_q_type << 395 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 396 397 wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg); 398 } 399 } 400 kfree(vf->qvlist_info); 401 vf->qvlist_info = NULL; 402 } 403 404 /** 405 * i40e_config_iwarp_qvlist 406 * @vf: pointer to the VF info 407 * @qvlist_info: queue and vector list 408 * 409 * Return 0 on success or < 0 on error 410 **/ 411 static int i40e_config_iwarp_qvlist(struct i40e_vf *vf, 412 struct i40e_virtchnl_iwarp_qvlist_info *qvlist_info) 413 { 414 struct i40e_pf *pf = vf->pf; 415 struct i40e_hw *hw = &pf->hw; 416 struct i40e_virtchnl_iwarp_qv_info *qv_info; 417 u32 v_idx, i, reg_idx, reg; 418 u32 next_q_idx, next_q_type; 419 u32 msix_vf, size; 420 421 size = sizeof(struct i40e_virtchnl_iwarp_qvlist_info) + 422 (sizeof(struct i40e_virtchnl_iwarp_qv_info) * 423 (qvlist_info->num_vectors - 1)); 424 vf->qvlist_info = kzalloc(size, GFP_KERNEL); 425 vf->qvlist_info->num_vectors = qvlist_info->num_vectors; 426 427 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 428 for (i = 0; i < qvlist_info->num_vectors; i++) { 429 qv_info = &qvlist_info->qv_info[i]; 430 if (!qv_info) 431 continue; 432 v_idx = qv_info->v_idx; 433 434 /* Validate vector id belongs to this vf */ 435 if (!i40e_vc_isvalid_vector_id(vf, v_idx)) 436 goto err; 437 438 vf->qvlist_info->qv_info[i] = *qv_info; 439 440 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 441 /* We might be sharing the interrupt, so get the first queue 442 * index and type, push it down the list by adding the new 443 * queue on top. Also link it with the new queue in CEQCTL. 444 */ 445 reg = rd32(hw, I40E_VPINT_LNKLSTN(reg_idx)); 446 next_q_idx = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) >> 447 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_SHIFT); 448 next_q_type = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK) >> 449 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 450 451 if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) { 452 reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx; 453 reg = (I40E_VPINT_CEQCTL_CAUSE_ENA_MASK | 454 (v_idx << I40E_VPINT_CEQCTL_MSIX_INDX_SHIFT) | 455 (qv_info->itr_idx << I40E_VPINT_CEQCTL_ITR_INDX_SHIFT) | 456 (next_q_type << I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT) | 457 (next_q_idx << I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT)); 458 wr32(hw, I40E_VPINT_CEQCTL(reg_idx), reg); 459 460 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 461 reg = (qv_info->ceq_idx & 462 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) | 463 (I40E_QUEUE_TYPE_PE_CEQ << 464 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 465 wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg); 466 } 467 468 if (qv_info->aeq_idx != I40E_QUEUE_INVALID_IDX) { 469 reg = (I40E_VPINT_AEQCTL_CAUSE_ENA_MASK | 470 (v_idx << I40E_VPINT_AEQCTL_MSIX_INDX_SHIFT) | 471 (qv_info->itr_idx << I40E_VPINT_AEQCTL_ITR_INDX_SHIFT)); 472 473 wr32(hw, I40E_VPINT_AEQCTL(vf->vf_id), reg); 474 } 475 } 476 477 return 0; 478 err: 479 kfree(vf->qvlist_info); 480 vf->qvlist_info = NULL; 481 return -EINVAL; 482 } 483 484 /** 485 * i40e_config_vsi_tx_queue 486 * @vf: pointer to the VF info 487 * @vsi_id: id of VSI as provided by the FW 488 * @vsi_queue_id: vsi relative queue index 489 * @info: config. info 490 * 491 * configure tx queue 492 **/ 493 static int i40e_config_vsi_tx_queue(struct i40e_vf *vf, u16 vsi_id, 494 u16 vsi_queue_id, 495 struct i40e_virtchnl_txq_info *info) 496 { 497 struct i40e_pf *pf = vf->pf; 498 struct i40e_hw *hw = &pf->hw; 499 struct i40e_hmc_obj_txq tx_ctx; 500 struct i40e_vsi *vsi; 501 u16 pf_queue_id; 502 u32 qtx_ctl; 503 int ret = 0; 504 505 if (!i40e_vc_isvalid_vsi_id(vf, info->vsi_id)) { 506 ret = -ENOENT; 507 goto error_context; 508 } 509 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id); 510 vsi = i40e_find_vsi_from_id(pf, vsi_id); 511 if (!vsi) { 512 ret = -ENOENT; 513 goto error_context; 514 } 515 516 /* clear the context structure first */ 517 memset(&tx_ctx, 0, sizeof(struct i40e_hmc_obj_txq)); 518 519 /* only set the required fields */ 520 tx_ctx.base = info->dma_ring_addr / 128; 521 tx_ctx.qlen = info->ring_len; 522 tx_ctx.rdylist = le16_to_cpu(vsi->info.qs_handle[0]); 523 tx_ctx.rdylist_act = 0; 524 tx_ctx.head_wb_ena = info->headwb_enabled; 525 tx_ctx.head_wb_addr = info->dma_headwb_addr; 526 527 /* clear the context in the HMC */ 528 ret = i40e_clear_lan_tx_queue_context(hw, pf_queue_id); 529 if (ret) { 530 dev_err(&pf->pdev->dev, 531 "Failed to clear VF LAN Tx queue context %d, error: %d\n", 532 pf_queue_id, ret); 533 ret = -ENOENT; 534 goto error_context; 535 } 536 537 /* set the context in the HMC */ 538 ret = i40e_set_lan_tx_queue_context(hw, pf_queue_id, &tx_ctx); 539 if (ret) { 540 dev_err(&pf->pdev->dev, 541 "Failed to set VF LAN Tx queue context %d error: %d\n", 542 pf_queue_id, ret); 543 ret = -ENOENT; 544 goto error_context; 545 } 546 547 /* associate this queue with the PCI VF function */ 548 qtx_ctl = I40E_QTX_CTL_VF_QUEUE; 549 qtx_ctl |= ((hw->pf_id << I40E_QTX_CTL_PF_INDX_SHIFT) 550 & I40E_QTX_CTL_PF_INDX_MASK); 551 qtx_ctl |= (((vf->vf_id + hw->func_caps.vf_base_id) 552 << I40E_QTX_CTL_VFVM_INDX_SHIFT) 553 & I40E_QTX_CTL_VFVM_INDX_MASK); 554 wr32(hw, I40E_QTX_CTL(pf_queue_id), qtx_ctl); 555 i40e_flush(hw); 556 557 error_context: 558 return ret; 559 } 560 561 /** 562 * i40e_config_vsi_rx_queue 563 * @vf: pointer to the VF info 564 * @vsi_id: id of VSI as provided by the FW 565 * @vsi_queue_id: vsi relative queue index 566 * @info: config. info 567 * 568 * configure rx queue 569 **/ 570 static int i40e_config_vsi_rx_queue(struct i40e_vf *vf, u16 vsi_id, 571 u16 vsi_queue_id, 572 struct i40e_virtchnl_rxq_info *info) 573 { 574 struct i40e_pf *pf = vf->pf; 575 struct i40e_hw *hw = &pf->hw; 576 struct i40e_hmc_obj_rxq rx_ctx; 577 u16 pf_queue_id; 578 int ret = 0; 579 580 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id); 581 582 /* clear the context structure first */ 583 memset(&rx_ctx, 0, sizeof(struct i40e_hmc_obj_rxq)); 584 585 /* only set the required fields */ 586 rx_ctx.base = info->dma_ring_addr / 128; 587 rx_ctx.qlen = info->ring_len; 588 589 if (info->splithdr_enabled) { 590 rx_ctx.hsplit_0 = I40E_RX_SPLIT_L2 | 591 I40E_RX_SPLIT_IP | 592 I40E_RX_SPLIT_TCP_UDP | 593 I40E_RX_SPLIT_SCTP; 594 /* header length validation */ 595 if (info->hdr_size > ((2 * 1024) - 64)) { 596 ret = -EINVAL; 597 goto error_param; 598 } 599 rx_ctx.hbuff = info->hdr_size >> I40E_RXQ_CTX_HBUFF_SHIFT; 600 601 /* set split mode 10b */ 602 rx_ctx.dtype = I40E_RX_DTYPE_HEADER_SPLIT; 603 } 604 605 /* databuffer length validation */ 606 if (info->databuffer_size > ((16 * 1024) - 128)) { 607 ret = -EINVAL; 608 goto error_param; 609 } 610 rx_ctx.dbuff = info->databuffer_size >> I40E_RXQ_CTX_DBUFF_SHIFT; 611 612 /* max pkt. length validation */ 613 if (info->max_pkt_size >= (16 * 1024) || info->max_pkt_size < 64) { 614 ret = -EINVAL; 615 goto error_param; 616 } 617 rx_ctx.rxmax = info->max_pkt_size; 618 619 /* enable 32bytes desc always */ 620 rx_ctx.dsize = 1; 621 622 /* default values */ 623 rx_ctx.lrxqthresh = 2; 624 rx_ctx.crcstrip = 1; 625 rx_ctx.prefena = 1; 626 rx_ctx.l2tsel = 1; 627 628 /* clear the context in the HMC */ 629 ret = i40e_clear_lan_rx_queue_context(hw, pf_queue_id); 630 if (ret) { 631 dev_err(&pf->pdev->dev, 632 "Failed to clear VF LAN Rx queue context %d, error: %d\n", 633 pf_queue_id, ret); 634 ret = -ENOENT; 635 goto error_param; 636 } 637 638 /* set the context in the HMC */ 639 ret = i40e_set_lan_rx_queue_context(hw, pf_queue_id, &rx_ctx); 640 if (ret) { 641 dev_err(&pf->pdev->dev, 642 "Failed to set VF LAN Rx queue context %d error: %d\n", 643 pf_queue_id, ret); 644 ret = -ENOENT; 645 goto error_param; 646 } 647 648 error_param: 649 return ret; 650 } 651 652 /** 653 * i40e_alloc_vsi_res 654 * @vf: pointer to the VF info 655 * @type: type of VSI to allocate 656 * 657 * alloc VF vsi context & resources 658 **/ 659 static int i40e_alloc_vsi_res(struct i40e_vf *vf, enum i40e_vsi_type type) 660 { 661 struct i40e_mac_filter *f = NULL; 662 struct i40e_pf *pf = vf->pf; 663 struct i40e_vsi *vsi; 664 int ret = 0; 665 666 vsi = i40e_vsi_setup(pf, type, pf->vsi[pf->lan_vsi]->seid, vf->vf_id); 667 668 if (!vsi) { 669 dev_err(&pf->pdev->dev, 670 "add vsi failed for VF %d, aq_err %d\n", 671 vf->vf_id, pf->hw.aq.asq_last_status); 672 ret = -ENOENT; 673 goto error_alloc_vsi_res; 674 } 675 if (type == I40E_VSI_SRIOV) { 676 u64 hena = i40e_pf_get_default_rss_hena(pf); 677 678 vf->lan_vsi_idx = vsi->idx; 679 vf->lan_vsi_id = vsi->id; 680 /* If the port VLAN has been configured and then the 681 * VF driver was removed then the VSI port VLAN 682 * configuration was destroyed. Check if there is 683 * a port VLAN and restore the VSI configuration if 684 * needed. 685 */ 686 if (vf->port_vlan_id) 687 i40e_vsi_add_pvid(vsi, vf->port_vlan_id); 688 689 spin_lock_bh(&vsi->mac_filter_list_lock); 690 if (is_valid_ether_addr(vf->default_lan_addr.addr)) { 691 f = i40e_add_filter(vsi, vf->default_lan_addr.addr, 692 vf->port_vlan_id ? vf->port_vlan_id : -1, 693 true, false); 694 if (!f) 695 dev_info(&pf->pdev->dev, 696 "Could not add MAC filter %pM for VF %d\n", 697 vf->default_lan_addr.addr, vf->vf_id); 698 } 699 spin_unlock_bh(&vsi->mac_filter_list_lock); 700 i40e_write_rx_ctl(&pf->hw, I40E_VFQF_HENA1(0, vf->vf_id), 701 (u32)hena); 702 i40e_write_rx_ctl(&pf->hw, I40E_VFQF_HENA1(1, vf->vf_id), 703 (u32)(hena >> 32)); 704 } 705 706 /* program mac filter */ 707 ret = i40e_sync_vsi_filters(vsi); 708 if (ret) 709 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n"); 710 711 /* Set VF bandwidth if specified */ 712 if (vf->tx_rate) { 713 ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid, 714 vf->tx_rate / 50, 0, NULL); 715 if (ret) 716 dev_err(&pf->pdev->dev, "Unable to set tx rate, VF %d, error code %d.\n", 717 vf->vf_id, ret); 718 } 719 720 error_alloc_vsi_res: 721 return ret; 722 } 723 724 /** 725 * i40e_enable_vf_mappings 726 * @vf: pointer to the VF info 727 * 728 * enable VF mappings 729 **/ 730 static void i40e_enable_vf_mappings(struct i40e_vf *vf) 731 { 732 struct i40e_pf *pf = vf->pf; 733 struct i40e_hw *hw = &pf->hw; 734 u32 reg, total_queue_pairs = 0; 735 int j; 736 737 /* Tell the hardware we're using noncontiguous mapping. HW requires 738 * that VF queues be mapped using this method, even when they are 739 * contiguous in real life 740 */ 741 i40e_write_rx_ctl(hw, I40E_VSILAN_QBASE(vf->lan_vsi_id), 742 I40E_VSILAN_QBASE_VSIQTABLE_ENA_MASK); 743 744 /* enable VF vplan_qtable mappings */ 745 reg = I40E_VPLAN_MAPENA_TXRX_ENA_MASK; 746 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), reg); 747 748 /* map PF queues to VF queues */ 749 for (j = 0; j < pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs; j++) { 750 u16 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_id, j); 751 752 reg = (qid & I40E_VPLAN_QTABLE_QINDEX_MASK); 753 wr32(hw, I40E_VPLAN_QTABLE(total_queue_pairs, vf->vf_id), reg); 754 total_queue_pairs++; 755 } 756 757 /* map PF queues to VSI */ 758 for (j = 0; j < 7; j++) { 759 if (j * 2 >= pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs) { 760 reg = 0x07FF07FF; /* unused */ 761 } else { 762 u16 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_id, 763 j * 2); 764 reg = qid; 765 qid = i40e_vc_get_pf_queue_id(vf, vf->lan_vsi_id, 766 (j * 2) + 1); 767 reg |= qid << 16; 768 } 769 i40e_write_rx_ctl(hw, I40E_VSILAN_QTABLE(j, vf->lan_vsi_id), 770 reg); 771 } 772 773 i40e_flush(hw); 774 } 775 776 /** 777 * i40e_disable_vf_mappings 778 * @vf: pointer to the VF info 779 * 780 * disable VF mappings 781 **/ 782 static void i40e_disable_vf_mappings(struct i40e_vf *vf) 783 { 784 struct i40e_pf *pf = vf->pf; 785 struct i40e_hw *hw = &pf->hw; 786 int i; 787 788 /* disable qp mappings */ 789 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), 0); 790 for (i = 0; i < I40E_MAX_VSI_QP; i++) 791 wr32(hw, I40E_VPLAN_QTABLE(i, vf->vf_id), 792 I40E_QUEUE_END_OF_LIST); 793 i40e_flush(hw); 794 } 795 796 /** 797 * i40e_free_vf_res 798 * @vf: pointer to the VF info 799 * 800 * free VF resources 801 **/ 802 static void i40e_free_vf_res(struct i40e_vf *vf) 803 { 804 struct i40e_pf *pf = vf->pf; 805 struct i40e_hw *hw = &pf->hw; 806 u32 reg_idx, reg; 807 int i, msix_vf; 808 809 /* free vsi & disconnect it from the parent uplink */ 810 if (vf->lan_vsi_idx) { 811 i40e_vsi_release(pf->vsi[vf->lan_vsi_idx]); 812 vf->lan_vsi_idx = 0; 813 vf->lan_vsi_id = 0; 814 } 815 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 816 817 /* disable interrupts so the VF starts in a known state */ 818 for (i = 0; i < msix_vf; i++) { 819 /* format is same for both registers */ 820 if (0 == i) 821 reg_idx = I40E_VFINT_DYN_CTL0(vf->vf_id); 822 else 823 reg_idx = I40E_VFINT_DYN_CTLN(((msix_vf - 1) * 824 (vf->vf_id)) 825 + (i - 1)); 826 wr32(hw, reg_idx, I40E_VFINT_DYN_CTLN_CLEARPBA_MASK); 827 i40e_flush(hw); 828 } 829 830 /* clear the irq settings */ 831 for (i = 0; i < msix_vf; i++) { 832 /* format is same for both registers */ 833 if (0 == i) 834 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id); 835 else 836 reg_idx = I40E_VPINT_LNKLSTN(((msix_vf - 1) * 837 (vf->vf_id)) 838 + (i - 1)); 839 reg = (I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK | 840 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK); 841 wr32(hw, reg_idx, reg); 842 i40e_flush(hw); 843 } 844 /* reset some of the state varibles keeping 845 * track of the resources 846 */ 847 vf->num_queue_pairs = 0; 848 vf->vf_states = 0; 849 clear_bit(I40E_VF_STAT_INIT, &vf->vf_states); 850 } 851 852 /** 853 * i40e_alloc_vf_res 854 * @vf: pointer to the VF info 855 * 856 * allocate VF resources 857 **/ 858 static int i40e_alloc_vf_res(struct i40e_vf *vf) 859 { 860 struct i40e_pf *pf = vf->pf; 861 int total_queue_pairs = 0; 862 int ret; 863 864 /* allocate hw vsi context & associated resources */ 865 ret = i40e_alloc_vsi_res(vf, I40E_VSI_SRIOV); 866 if (ret) 867 goto error_alloc; 868 total_queue_pairs += pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs; 869 870 if (vf->trusted) 871 set_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps); 872 else 873 clear_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps); 874 875 /* store the total qps number for the runtime 876 * VF req validation 877 */ 878 vf->num_queue_pairs = total_queue_pairs; 879 880 /* VF is now completely initialized */ 881 set_bit(I40E_VF_STAT_INIT, &vf->vf_states); 882 883 error_alloc: 884 if (ret) 885 i40e_free_vf_res(vf); 886 887 return ret; 888 } 889 890 #define VF_DEVICE_STATUS 0xAA 891 #define VF_TRANS_PENDING_MASK 0x20 892 /** 893 * i40e_quiesce_vf_pci 894 * @vf: pointer to the VF structure 895 * 896 * Wait for VF PCI transactions to be cleared after reset. Returns -EIO 897 * if the transactions never clear. 898 **/ 899 static int i40e_quiesce_vf_pci(struct i40e_vf *vf) 900 { 901 struct i40e_pf *pf = vf->pf; 902 struct i40e_hw *hw = &pf->hw; 903 int vf_abs_id, i; 904 u32 reg; 905 906 vf_abs_id = vf->vf_id + hw->func_caps.vf_base_id; 907 908 wr32(hw, I40E_PF_PCI_CIAA, 909 VF_DEVICE_STATUS | (vf_abs_id << I40E_PF_PCI_CIAA_VF_NUM_SHIFT)); 910 for (i = 0; i < 100; i++) { 911 reg = rd32(hw, I40E_PF_PCI_CIAD); 912 if ((reg & VF_TRANS_PENDING_MASK) == 0) 913 return 0; 914 udelay(1); 915 } 916 return -EIO; 917 } 918 919 /** 920 * i40e_reset_vf 921 * @vf: pointer to the VF structure 922 * @flr: VFLR was issued or not 923 * 924 * reset the VF 925 **/ 926 void i40e_reset_vf(struct i40e_vf *vf, bool flr) 927 { 928 struct i40e_pf *pf = vf->pf; 929 struct i40e_hw *hw = &pf->hw; 930 u32 reg, reg_idx, bit_idx; 931 bool rsd = false; 932 int i; 933 934 if (test_and_set_bit(__I40E_VF_DISABLE, &pf->state)) 935 return; 936 937 /* warn the VF */ 938 clear_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states); 939 940 /* In the case of a VFLR, the HW has already reset the VF and we 941 * just need to clean up, so don't hit the VFRTRIG register. 942 */ 943 if (!flr) { 944 /* reset VF using VPGEN_VFRTRIG reg */ 945 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id)); 946 reg |= I40E_VPGEN_VFRTRIG_VFSWR_MASK; 947 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg); 948 i40e_flush(hw); 949 } 950 /* clear the VFLR bit in GLGEN_VFLRSTAT */ 951 reg_idx = (hw->func_caps.vf_base_id + vf->vf_id) / 32; 952 bit_idx = (hw->func_caps.vf_base_id + vf->vf_id) % 32; 953 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx)); 954 i40e_flush(hw); 955 956 if (i40e_quiesce_vf_pci(vf)) 957 dev_err(&pf->pdev->dev, "VF %d PCI transactions stuck\n", 958 vf->vf_id); 959 960 /* poll VPGEN_VFRSTAT reg to make sure 961 * that reset is complete 962 */ 963 for (i = 0; i < 10; i++) { 964 /* VF reset requires driver to first reset the VF and then 965 * poll the status register to make sure that the reset 966 * completed successfully. Due to internal HW FIFO flushes, 967 * we must wait 10ms before the register will be valid. 968 */ 969 usleep_range(10000, 20000); 970 reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id)); 971 if (reg & I40E_VPGEN_VFRSTAT_VFRD_MASK) { 972 rsd = true; 973 break; 974 } 975 } 976 977 if (flr) 978 usleep_range(10000, 20000); 979 980 if (!rsd) 981 dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n", 982 vf->vf_id); 983 wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), I40E_VFR_COMPLETED); 984 /* clear the reset bit in the VPGEN_VFRTRIG reg */ 985 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id)); 986 reg &= ~I40E_VPGEN_VFRTRIG_VFSWR_MASK; 987 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg); 988 989 /* On initial reset, we won't have any queues */ 990 if (vf->lan_vsi_idx == 0) 991 goto complete_reset; 992 993 i40e_vsi_control_rings(pf->vsi[vf->lan_vsi_idx], false); 994 complete_reset: 995 /* reallocate VF resources to reset the VSI state */ 996 i40e_free_vf_res(vf); 997 if (!i40e_alloc_vf_res(vf)) { 998 int abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 999 i40e_enable_vf_mappings(vf); 1000 set_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states); 1001 clear_bit(I40E_VF_STAT_DISABLED, &vf->vf_states); 1002 /* Do not notify the client during VF init */ 1003 if (vf->pf->num_alloc_vfs) 1004 i40e_notify_client_of_vf_reset(pf, abs_vf_id); 1005 vf->num_vlan = 0; 1006 } 1007 /* tell the VF the reset is done */ 1008 wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), I40E_VFR_VFACTIVE); 1009 1010 i40e_flush(hw); 1011 clear_bit(__I40E_VF_DISABLE, &pf->state); 1012 } 1013 1014 /** 1015 * i40e_free_vfs 1016 * @pf: pointer to the PF structure 1017 * 1018 * free VF resources 1019 **/ 1020 void i40e_free_vfs(struct i40e_pf *pf) 1021 { 1022 struct i40e_hw *hw = &pf->hw; 1023 u32 reg_idx, bit_idx; 1024 int i, tmp, vf_id; 1025 1026 if (!pf->vf) 1027 return; 1028 while (test_and_set_bit(__I40E_VF_DISABLE, &pf->state)) 1029 usleep_range(1000, 2000); 1030 1031 i40e_notify_client_of_vf_enable(pf, 0); 1032 for (i = 0; i < pf->num_alloc_vfs; i++) 1033 if (test_bit(I40E_VF_STAT_INIT, &pf->vf[i].vf_states)) 1034 i40e_vsi_control_rings(pf->vsi[pf->vf[i].lan_vsi_idx], 1035 false); 1036 1037 /* Disable IOV before freeing resources. This lets any VF drivers 1038 * running in the host get themselves cleaned up before we yank 1039 * the carpet out from underneath their feet. 1040 */ 1041 if (!pci_vfs_assigned(pf->pdev)) 1042 pci_disable_sriov(pf->pdev); 1043 else 1044 dev_warn(&pf->pdev->dev, "VFs are assigned - not disabling SR-IOV\n"); 1045 1046 msleep(20); /* let any messages in transit get finished up */ 1047 1048 /* free up VF resources */ 1049 tmp = pf->num_alloc_vfs; 1050 pf->num_alloc_vfs = 0; 1051 for (i = 0; i < tmp; i++) { 1052 if (test_bit(I40E_VF_STAT_INIT, &pf->vf[i].vf_states)) 1053 i40e_free_vf_res(&pf->vf[i]); 1054 /* disable qp mappings */ 1055 i40e_disable_vf_mappings(&pf->vf[i]); 1056 } 1057 1058 kfree(pf->vf); 1059 pf->vf = NULL; 1060 1061 /* This check is for when the driver is unloaded while VFs are 1062 * assigned. Setting the number of VFs to 0 through sysfs is caught 1063 * before this function ever gets called. 1064 */ 1065 if (!pci_vfs_assigned(pf->pdev)) { 1066 /* Acknowledge VFLR for all VFS. Without this, VFs will fail to 1067 * work correctly when SR-IOV gets re-enabled. 1068 */ 1069 for (vf_id = 0; vf_id < tmp; vf_id++) { 1070 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32; 1071 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32; 1072 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx)); 1073 } 1074 } 1075 clear_bit(__I40E_VF_DISABLE, &pf->state); 1076 } 1077 1078 #ifdef CONFIG_PCI_IOV 1079 /** 1080 * i40e_alloc_vfs 1081 * @pf: pointer to the PF structure 1082 * @num_alloc_vfs: number of VFs to allocate 1083 * 1084 * allocate VF resources 1085 **/ 1086 int i40e_alloc_vfs(struct i40e_pf *pf, u16 num_alloc_vfs) 1087 { 1088 struct i40e_vf *vfs; 1089 int i, ret = 0; 1090 1091 /* Disable interrupt 0 so we don't try to handle the VFLR. */ 1092 i40e_irq_dynamic_disable_icr0(pf); 1093 1094 /* Check to see if we're just allocating resources for extant VFs */ 1095 if (pci_num_vf(pf->pdev) != num_alloc_vfs) { 1096 ret = pci_enable_sriov(pf->pdev, num_alloc_vfs); 1097 if (ret) { 1098 pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED; 1099 pf->num_alloc_vfs = 0; 1100 goto err_iov; 1101 } 1102 } 1103 /* allocate memory */ 1104 vfs = kcalloc(num_alloc_vfs, sizeof(struct i40e_vf), GFP_KERNEL); 1105 if (!vfs) { 1106 ret = -ENOMEM; 1107 goto err_alloc; 1108 } 1109 pf->vf = vfs; 1110 1111 /* apply default profile */ 1112 for (i = 0; i < num_alloc_vfs; i++) { 1113 vfs[i].pf = pf; 1114 vfs[i].parent_type = I40E_SWITCH_ELEMENT_TYPE_VEB; 1115 vfs[i].vf_id = i; 1116 1117 /* assign default capabilities */ 1118 set_bit(I40E_VIRTCHNL_VF_CAP_L2, &vfs[i].vf_caps); 1119 vfs[i].spoofchk = true; 1120 /* VF resources get allocated during reset */ 1121 i40e_reset_vf(&vfs[i], false); 1122 1123 } 1124 pf->num_alloc_vfs = num_alloc_vfs; 1125 1126 i40e_notify_client_of_vf_enable(pf, num_alloc_vfs); 1127 1128 err_alloc: 1129 if (ret) 1130 i40e_free_vfs(pf); 1131 err_iov: 1132 /* Re-enable interrupt 0. */ 1133 i40e_irq_dynamic_enable_icr0(pf, false); 1134 return ret; 1135 } 1136 1137 #endif 1138 /** 1139 * i40e_pci_sriov_enable 1140 * @pdev: pointer to a pci_dev structure 1141 * @num_vfs: number of VFs to allocate 1142 * 1143 * Enable or change the number of VFs 1144 **/ 1145 static int i40e_pci_sriov_enable(struct pci_dev *pdev, int num_vfs) 1146 { 1147 #ifdef CONFIG_PCI_IOV 1148 struct i40e_pf *pf = pci_get_drvdata(pdev); 1149 int pre_existing_vfs = pci_num_vf(pdev); 1150 int err = 0; 1151 1152 if (test_bit(__I40E_TESTING, &pf->state)) { 1153 dev_warn(&pdev->dev, 1154 "Cannot enable SR-IOV virtual functions while the device is undergoing diagnostic testing\n"); 1155 err = -EPERM; 1156 goto err_out; 1157 } 1158 1159 if (pre_existing_vfs && pre_existing_vfs != num_vfs) 1160 i40e_free_vfs(pf); 1161 else if (pre_existing_vfs && pre_existing_vfs == num_vfs) 1162 goto out; 1163 1164 if (num_vfs > pf->num_req_vfs) { 1165 dev_warn(&pdev->dev, "Unable to enable %d VFs. Limited to %d VFs due to device resource constraints.\n", 1166 num_vfs, pf->num_req_vfs); 1167 err = -EPERM; 1168 goto err_out; 1169 } 1170 1171 dev_info(&pdev->dev, "Allocating %d VFs.\n", num_vfs); 1172 err = i40e_alloc_vfs(pf, num_vfs); 1173 if (err) { 1174 dev_warn(&pdev->dev, "Failed to enable SR-IOV: %d\n", err); 1175 goto err_out; 1176 } 1177 1178 out: 1179 return num_vfs; 1180 1181 err_out: 1182 return err; 1183 #endif 1184 return 0; 1185 } 1186 1187 /** 1188 * i40e_pci_sriov_configure 1189 * @pdev: pointer to a pci_dev structure 1190 * @num_vfs: number of VFs to allocate 1191 * 1192 * Enable or change the number of VFs. Called when the user updates the number 1193 * of VFs in sysfs. 1194 **/ 1195 int i40e_pci_sriov_configure(struct pci_dev *pdev, int num_vfs) 1196 { 1197 struct i40e_pf *pf = pci_get_drvdata(pdev); 1198 1199 if (num_vfs) { 1200 if (!(pf->flags & I40E_FLAG_VEB_MODE_ENABLED)) { 1201 pf->flags |= I40E_FLAG_VEB_MODE_ENABLED; 1202 i40e_do_reset_safe(pf, 1203 BIT_ULL(__I40E_PF_RESET_REQUESTED)); 1204 } 1205 return i40e_pci_sriov_enable(pdev, num_vfs); 1206 } 1207 1208 if (!pci_vfs_assigned(pf->pdev)) { 1209 i40e_free_vfs(pf); 1210 pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED; 1211 i40e_do_reset_safe(pf, BIT_ULL(__I40E_PF_RESET_REQUESTED)); 1212 } else { 1213 dev_warn(&pdev->dev, "Unable to free VFs because some are assigned to VMs.\n"); 1214 return -EINVAL; 1215 } 1216 return 0; 1217 } 1218 1219 /***********************virtual channel routines******************/ 1220 1221 /** 1222 * i40e_vc_send_msg_to_vf 1223 * @vf: pointer to the VF info 1224 * @v_opcode: virtual channel opcode 1225 * @v_retval: virtual channel return value 1226 * @msg: pointer to the msg buffer 1227 * @msglen: msg length 1228 * 1229 * send msg to VF 1230 **/ 1231 static int i40e_vc_send_msg_to_vf(struct i40e_vf *vf, u32 v_opcode, 1232 u32 v_retval, u8 *msg, u16 msglen) 1233 { 1234 struct i40e_pf *pf; 1235 struct i40e_hw *hw; 1236 int abs_vf_id; 1237 i40e_status aq_ret; 1238 1239 /* validate the request */ 1240 if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs) 1241 return -EINVAL; 1242 1243 pf = vf->pf; 1244 hw = &pf->hw; 1245 abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 1246 1247 /* single place to detect unsuccessful return values */ 1248 if (v_retval) { 1249 vf->num_invalid_msgs++; 1250 dev_info(&pf->pdev->dev, "VF %d failed opcode %d, retval: %d\n", 1251 vf->vf_id, v_opcode, v_retval); 1252 if (vf->num_invalid_msgs > 1253 I40E_DEFAULT_NUM_INVALID_MSGS_ALLOWED) { 1254 dev_err(&pf->pdev->dev, 1255 "Number of invalid messages exceeded for VF %d\n", 1256 vf->vf_id); 1257 dev_err(&pf->pdev->dev, "Use PF Control I/F to enable the VF\n"); 1258 set_bit(I40E_VF_STAT_DISABLED, &vf->vf_states); 1259 } 1260 } else { 1261 vf->num_valid_msgs++; 1262 /* reset the invalid counter, if a valid message is received. */ 1263 vf->num_invalid_msgs = 0; 1264 } 1265 1266 aq_ret = i40e_aq_send_msg_to_vf(hw, abs_vf_id, v_opcode, v_retval, 1267 msg, msglen, NULL); 1268 if (aq_ret) { 1269 dev_info(&pf->pdev->dev, 1270 "Unable to send the message to VF %d aq_err %d\n", 1271 vf->vf_id, pf->hw.aq.asq_last_status); 1272 return -EIO; 1273 } 1274 1275 return 0; 1276 } 1277 1278 /** 1279 * i40e_vc_send_resp_to_vf 1280 * @vf: pointer to the VF info 1281 * @opcode: operation code 1282 * @retval: return value 1283 * 1284 * send resp msg to VF 1285 **/ 1286 static int i40e_vc_send_resp_to_vf(struct i40e_vf *vf, 1287 enum i40e_virtchnl_ops opcode, 1288 i40e_status retval) 1289 { 1290 return i40e_vc_send_msg_to_vf(vf, opcode, retval, NULL, 0); 1291 } 1292 1293 /** 1294 * i40e_vc_get_version_msg 1295 * @vf: pointer to the VF info 1296 * 1297 * called from the VF to request the API version used by the PF 1298 **/ 1299 static int i40e_vc_get_version_msg(struct i40e_vf *vf, u8 *msg) 1300 { 1301 struct i40e_virtchnl_version_info info = { 1302 I40E_VIRTCHNL_VERSION_MAJOR, I40E_VIRTCHNL_VERSION_MINOR 1303 }; 1304 1305 vf->vf_ver = *(struct i40e_virtchnl_version_info *)msg; 1306 /* VFs running the 1.0 API expect to get 1.0 back or they will cry. */ 1307 if (VF_IS_V10(vf)) 1308 info.minor = I40E_VIRTCHNL_VERSION_MINOR_NO_VF_CAPS; 1309 return i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_VERSION, 1310 I40E_SUCCESS, (u8 *)&info, 1311 sizeof(struct 1312 i40e_virtchnl_version_info)); 1313 } 1314 1315 /** 1316 * i40e_vc_get_vf_resources_msg 1317 * @vf: pointer to the VF info 1318 * @msg: pointer to the msg buffer 1319 * @msglen: msg length 1320 * 1321 * called from the VF to request its resources 1322 **/ 1323 static int i40e_vc_get_vf_resources_msg(struct i40e_vf *vf, u8 *msg) 1324 { 1325 struct i40e_virtchnl_vf_resource *vfres = NULL; 1326 struct i40e_pf *pf = vf->pf; 1327 i40e_status aq_ret = 0; 1328 struct i40e_vsi *vsi; 1329 int num_vsis = 1; 1330 int len = 0; 1331 int ret; 1332 1333 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 1334 aq_ret = I40E_ERR_PARAM; 1335 goto err; 1336 } 1337 1338 len = (sizeof(struct i40e_virtchnl_vf_resource) + 1339 sizeof(struct i40e_virtchnl_vsi_resource) * num_vsis); 1340 1341 vfres = kzalloc(len, GFP_KERNEL); 1342 if (!vfres) { 1343 aq_ret = I40E_ERR_NO_MEMORY; 1344 len = 0; 1345 goto err; 1346 } 1347 if (VF_IS_V11(vf)) 1348 vf->driver_caps = *(u32 *)msg; 1349 else 1350 vf->driver_caps = I40E_VIRTCHNL_VF_OFFLOAD_L2 | 1351 I40E_VIRTCHNL_VF_OFFLOAD_RSS_REG | 1352 I40E_VIRTCHNL_VF_OFFLOAD_VLAN; 1353 1354 vfres->vf_offload_flags = I40E_VIRTCHNL_VF_OFFLOAD_L2; 1355 vsi = pf->vsi[vf->lan_vsi_idx]; 1356 if (!vsi->info.pvid) 1357 vfres->vf_offload_flags |= I40E_VIRTCHNL_VF_OFFLOAD_VLAN; 1358 1359 if (i40e_vf_client_capable(pf, vf->vf_id, I40E_CLIENT_IWARP) && 1360 (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_IWARP)) { 1361 vfres->vf_offload_flags |= I40E_VIRTCHNL_VF_OFFLOAD_IWARP; 1362 set_bit(I40E_VF_STAT_IWARPENA, &vf->vf_states); 1363 } 1364 1365 if (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_RSS_PF) { 1366 vfres->vf_offload_flags |= I40E_VIRTCHNL_VF_OFFLOAD_RSS_PF; 1367 } else { 1368 if ((pf->flags & I40E_FLAG_RSS_AQ_CAPABLE) && 1369 (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_RSS_AQ)) 1370 vfres->vf_offload_flags |= 1371 I40E_VIRTCHNL_VF_OFFLOAD_RSS_AQ; 1372 else 1373 vfres->vf_offload_flags |= 1374 I40E_VIRTCHNL_VF_OFFLOAD_RSS_REG; 1375 } 1376 1377 if (pf->flags & I40E_FLAG_MULTIPLE_TCP_UDP_RSS_PCTYPE) { 1378 if (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2) 1379 vfres->vf_offload_flags |= 1380 I40E_VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2; 1381 } 1382 1383 if (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_RX_POLLING) { 1384 if (pf->flags & I40E_FLAG_MFP_ENABLED) { 1385 dev_err(&pf->pdev->dev, 1386 "VF %d requested polling mode: this feature is supported only when the device is running in single function per port (SFP) mode\n", 1387 vf->vf_id); 1388 ret = I40E_ERR_PARAM; 1389 goto err; 1390 } 1391 vfres->vf_offload_flags |= I40E_VIRTCHNL_VF_OFFLOAD_RX_POLLING; 1392 } 1393 1394 if (pf->flags & I40E_FLAG_WB_ON_ITR_CAPABLE) { 1395 if (vf->driver_caps & I40E_VIRTCHNL_VF_OFFLOAD_WB_ON_ITR) 1396 vfres->vf_offload_flags |= 1397 I40E_VIRTCHNL_VF_OFFLOAD_WB_ON_ITR; 1398 } 1399 1400 vfres->num_vsis = num_vsis; 1401 vfres->num_queue_pairs = vf->num_queue_pairs; 1402 vfres->max_vectors = pf->hw.func_caps.num_msix_vectors_vf; 1403 vfres->rss_key_size = I40E_HKEY_ARRAY_SIZE; 1404 vfres->rss_lut_size = I40E_VF_HLUT_ARRAY_SIZE; 1405 1406 if (vf->lan_vsi_idx) { 1407 vfres->vsi_res[0].vsi_id = vf->lan_vsi_id; 1408 vfres->vsi_res[0].vsi_type = I40E_VSI_SRIOV; 1409 vfres->vsi_res[0].num_queue_pairs = vsi->alloc_queue_pairs; 1410 /* VFs only use TC 0 */ 1411 vfres->vsi_res[0].qset_handle 1412 = le16_to_cpu(vsi->info.qs_handle[0]); 1413 ether_addr_copy(vfres->vsi_res[0].default_mac_addr, 1414 vf->default_lan_addr.addr); 1415 } 1416 set_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states); 1417 1418 err: 1419 /* send the response back to the VF */ 1420 ret = i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_GET_VF_RESOURCES, 1421 aq_ret, (u8 *)vfres, len); 1422 1423 kfree(vfres); 1424 return ret; 1425 } 1426 1427 /** 1428 * i40e_vc_reset_vf_msg 1429 * @vf: pointer to the VF info 1430 * @msg: pointer to the msg buffer 1431 * @msglen: msg length 1432 * 1433 * called from the VF to reset itself, 1434 * unlike other virtchnl messages, PF driver 1435 * doesn't send the response back to the VF 1436 **/ 1437 static void i40e_vc_reset_vf_msg(struct i40e_vf *vf) 1438 { 1439 if (test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) 1440 i40e_reset_vf(vf, false); 1441 } 1442 1443 /** 1444 * i40e_getnum_vf_vsi_vlan_filters 1445 * @vsi: pointer to the vsi 1446 * 1447 * called to get the number of VLANs offloaded on this VF 1448 **/ 1449 static inline int i40e_getnum_vf_vsi_vlan_filters(struct i40e_vsi *vsi) 1450 { 1451 struct i40e_mac_filter *f; 1452 int num_vlans = 0; 1453 1454 list_for_each_entry(f, &vsi->mac_filter_list, list) { 1455 if (f->vlan >= 0 && f->vlan <= I40E_MAX_VLANID) 1456 num_vlans++; 1457 } 1458 1459 return num_vlans; 1460 } 1461 1462 /** 1463 * i40e_vc_config_promiscuous_mode_msg 1464 * @vf: pointer to the VF info 1465 * @msg: pointer to the msg buffer 1466 * @msglen: msg length 1467 * 1468 * called from the VF to configure the promiscuous mode of 1469 * VF vsis 1470 **/ 1471 static int i40e_vc_config_promiscuous_mode_msg(struct i40e_vf *vf, 1472 u8 *msg, u16 msglen) 1473 { 1474 struct i40e_virtchnl_promisc_info *info = 1475 (struct i40e_virtchnl_promisc_info *)msg; 1476 struct i40e_pf *pf = vf->pf; 1477 struct i40e_hw *hw = &pf->hw; 1478 struct i40e_mac_filter *f; 1479 i40e_status aq_ret = 0; 1480 bool allmulti = false; 1481 struct i40e_vsi *vsi; 1482 bool alluni = false; 1483 int aq_err = 0; 1484 1485 vsi = i40e_find_vsi_from_id(pf, info->vsi_id); 1486 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 1487 !i40e_vc_isvalid_vsi_id(vf, info->vsi_id) || 1488 !vsi) { 1489 aq_ret = I40E_ERR_PARAM; 1490 goto error_param; 1491 } 1492 if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 1493 dev_err(&pf->pdev->dev, 1494 "Unprivileged VF %d is attempting to configure promiscuous mode\n", 1495 vf->vf_id); 1496 /* Lie to the VF on purpose. */ 1497 aq_ret = 0; 1498 goto error_param; 1499 } 1500 /* Multicast promiscuous handling*/ 1501 if (info->flags & I40E_FLAG_VF_MULTICAST_PROMISC) 1502 allmulti = true; 1503 1504 if (vf->port_vlan_id) { 1505 aq_ret = i40e_aq_set_vsi_mc_promisc_on_vlan(hw, vsi->seid, 1506 allmulti, 1507 vf->port_vlan_id, 1508 NULL); 1509 } else if (i40e_getnum_vf_vsi_vlan_filters(vsi)) { 1510 list_for_each_entry(f, &vsi->mac_filter_list, list) { 1511 if (f->vlan < 0 || f->vlan > I40E_MAX_VLANID) 1512 continue; 1513 aq_ret = i40e_aq_set_vsi_mc_promisc_on_vlan(hw, 1514 vsi->seid, 1515 allmulti, 1516 f->vlan, 1517 NULL); 1518 aq_err = pf->hw.aq.asq_last_status; 1519 if (aq_ret) { 1520 dev_err(&pf->pdev->dev, 1521 "Could not add VLAN %d to multicast promiscuous domain err %s aq_err %s\n", 1522 f->vlan, 1523 i40e_stat_str(&pf->hw, aq_ret), 1524 i40e_aq_str(&pf->hw, aq_err)); 1525 break; 1526 } 1527 } 1528 } else { 1529 aq_ret = i40e_aq_set_vsi_multicast_promiscuous(hw, vsi->seid, 1530 allmulti, NULL); 1531 aq_err = pf->hw.aq.asq_last_status; 1532 if (aq_ret) { 1533 dev_err(&pf->pdev->dev, 1534 "VF %d failed to set multicast promiscuous mode err %s aq_err %s\n", 1535 vf->vf_id, 1536 i40e_stat_str(&pf->hw, aq_ret), 1537 i40e_aq_str(&pf->hw, aq_err)); 1538 goto error_param_int; 1539 } 1540 } 1541 1542 if (!aq_ret) { 1543 dev_info(&pf->pdev->dev, 1544 "VF %d successfully set multicast promiscuous mode\n", 1545 vf->vf_id); 1546 if (allmulti) 1547 set_bit(I40E_VF_STAT_MC_PROMISC, &vf->vf_states); 1548 else 1549 clear_bit(I40E_VF_STAT_MC_PROMISC, &vf->vf_states); 1550 } 1551 1552 if (info->flags & I40E_FLAG_VF_UNICAST_PROMISC) 1553 alluni = true; 1554 if (vf->port_vlan_id) { 1555 aq_ret = i40e_aq_set_vsi_uc_promisc_on_vlan(hw, vsi->seid, 1556 alluni, 1557 vf->port_vlan_id, 1558 NULL); 1559 } else if (i40e_getnum_vf_vsi_vlan_filters(vsi)) { 1560 list_for_each_entry(f, &vsi->mac_filter_list, list) { 1561 aq_ret = 0; 1562 if (f->vlan >= 0 && f->vlan <= I40E_MAX_VLANID) { 1563 aq_ret = 1564 i40e_aq_set_vsi_uc_promisc_on_vlan(hw, 1565 vsi->seid, 1566 alluni, 1567 f->vlan, 1568 NULL); 1569 aq_err = pf->hw.aq.asq_last_status; 1570 } 1571 if (aq_ret) 1572 dev_err(&pf->pdev->dev, 1573 "Could not add VLAN %d to Unicast promiscuous domain err %s aq_err %s\n", 1574 f->vlan, 1575 i40e_stat_str(&pf->hw, aq_ret), 1576 i40e_aq_str(&pf->hw, aq_err)); 1577 } 1578 } else { 1579 aq_ret = i40e_aq_set_vsi_unicast_promiscuous(hw, vsi->seid, 1580 allmulti, NULL, 1581 true); 1582 aq_err = pf->hw.aq.asq_last_status; 1583 if (aq_ret) 1584 dev_err(&pf->pdev->dev, 1585 "VF %d failed to set unicast promiscuous mode %8.8x err %s aq_err %s\n", 1586 vf->vf_id, info->flags, 1587 i40e_stat_str(&pf->hw, aq_ret), 1588 i40e_aq_str(&pf->hw, aq_err)); 1589 } 1590 1591 error_param_int: 1592 if (!aq_ret) { 1593 dev_info(&pf->pdev->dev, 1594 "VF %d successfully set unicast promiscuous mode\n", 1595 vf->vf_id); 1596 if (alluni) 1597 set_bit(I40E_VF_STAT_UC_PROMISC, &vf->vf_states); 1598 else 1599 clear_bit(I40E_VF_STAT_UC_PROMISC, &vf->vf_states); 1600 } 1601 1602 error_param: 1603 /* send the response to the VF */ 1604 return i40e_vc_send_resp_to_vf(vf, 1605 I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE, 1606 aq_ret); 1607 } 1608 1609 /** 1610 * i40e_vc_config_queues_msg 1611 * @vf: pointer to the VF info 1612 * @msg: pointer to the msg buffer 1613 * @msglen: msg length 1614 * 1615 * called from the VF to configure the rx/tx 1616 * queues 1617 **/ 1618 static int i40e_vc_config_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1619 { 1620 struct i40e_virtchnl_vsi_queue_config_info *qci = 1621 (struct i40e_virtchnl_vsi_queue_config_info *)msg; 1622 struct i40e_virtchnl_queue_pair_info *qpi; 1623 struct i40e_pf *pf = vf->pf; 1624 u16 vsi_id, vsi_queue_id; 1625 i40e_status aq_ret = 0; 1626 int i; 1627 1628 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 1629 aq_ret = I40E_ERR_PARAM; 1630 goto error_param; 1631 } 1632 1633 vsi_id = qci->vsi_id; 1634 if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 1635 aq_ret = I40E_ERR_PARAM; 1636 goto error_param; 1637 } 1638 for (i = 0; i < qci->num_queue_pairs; i++) { 1639 qpi = &qci->qpair[i]; 1640 vsi_queue_id = qpi->txq.queue_id; 1641 if ((qpi->txq.vsi_id != vsi_id) || 1642 (qpi->rxq.vsi_id != vsi_id) || 1643 (qpi->rxq.queue_id != vsi_queue_id) || 1644 !i40e_vc_isvalid_queue_id(vf, vsi_id, vsi_queue_id)) { 1645 aq_ret = I40E_ERR_PARAM; 1646 goto error_param; 1647 } 1648 1649 if (i40e_config_vsi_rx_queue(vf, vsi_id, vsi_queue_id, 1650 &qpi->rxq) || 1651 i40e_config_vsi_tx_queue(vf, vsi_id, vsi_queue_id, 1652 &qpi->txq)) { 1653 aq_ret = I40E_ERR_PARAM; 1654 goto error_param; 1655 } 1656 } 1657 /* set vsi num_queue_pairs in use to num configured by VF */ 1658 pf->vsi[vf->lan_vsi_idx]->num_queue_pairs = qci->num_queue_pairs; 1659 1660 error_param: 1661 /* send the response to the VF */ 1662 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES, 1663 aq_ret); 1664 } 1665 1666 /** 1667 * i40e_vc_config_irq_map_msg 1668 * @vf: pointer to the VF info 1669 * @msg: pointer to the msg buffer 1670 * @msglen: msg length 1671 * 1672 * called from the VF to configure the irq to 1673 * queue map 1674 **/ 1675 static int i40e_vc_config_irq_map_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1676 { 1677 struct i40e_virtchnl_irq_map_info *irqmap_info = 1678 (struct i40e_virtchnl_irq_map_info *)msg; 1679 struct i40e_virtchnl_vector_map *map; 1680 u16 vsi_id, vsi_queue_id, vector_id; 1681 i40e_status aq_ret = 0; 1682 unsigned long tempmap; 1683 int i; 1684 1685 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 1686 aq_ret = I40E_ERR_PARAM; 1687 goto error_param; 1688 } 1689 1690 for (i = 0; i < irqmap_info->num_vectors; i++) { 1691 map = &irqmap_info->vecmap[i]; 1692 1693 vector_id = map->vector_id; 1694 vsi_id = map->vsi_id; 1695 /* validate msg params */ 1696 if (!i40e_vc_isvalid_vector_id(vf, vector_id) || 1697 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 1698 aq_ret = I40E_ERR_PARAM; 1699 goto error_param; 1700 } 1701 1702 /* lookout for the invalid queue index */ 1703 tempmap = map->rxq_map; 1704 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 1705 if (!i40e_vc_isvalid_queue_id(vf, vsi_id, 1706 vsi_queue_id)) { 1707 aq_ret = I40E_ERR_PARAM; 1708 goto error_param; 1709 } 1710 } 1711 1712 tempmap = map->txq_map; 1713 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 1714 if (!i40e_vc_isvalid_queue_id(vf, vsi_id, 1715 vsi_queue_id)) { 1716 aq_ret = I40E_ERR_PARAM; 1717 goto error_param; 1718 } 1719 } 1720 1721 i40e_config_irq_link_list(vf, vsi_id, map); 1722 } 1723 error_param: 1724 /* send the response to the VF */ 1725 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP, 1726 aq_ret); 1727 } 1728 1729 /** 1730 * i40e_vc_enable_queues_msg 1731 * @vf: pointer to the VF info 1732 * @msg: pointer to the msg buffer 1733 * @msglen: msg length 1734 * 1735 * called from the VF to enable all or specific queue(s) 1736 **/ 1737 static int i40e_vc_enable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1738 { 1739 struct i40e_virtchnl_queue_select *vqs = 1740 (struct i40e_virtchnl_queue_select *)msg; 1741 struct i40e_pf *pf = vf->pf; 1742 u16 vsi_id = vqs->vsi_id; 1743 i40e_status aq_ret = 0; 1744 1745 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 1746 aq_ret = I40E_ERR_PARAM; 1747 goto error_param; 1748 } 1749 1750 if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 1751 aq_ret = I40E_ERR_PARAM; 1752 goto error_param; 1753 } 1754 1755 if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) { 1756 aq_ret = I40E_ERR_PARAM; 1757 goto error_param; 1758 } 1759 1760 if (i40e_vsi_control_rings(pf->vsi[vf->lan_vsi_idx], true)) 1761 aq_ret = I40E_ERR_TIMEOUT; 1762 error_param: 1763 /* send the response to the VF */ 1764 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ENABLE_QUEUES, 1765 aq_ret); 1766 } 1767 1768 /** 1769 * i40e_vc_disable_queues_msg 1770 * @vf: pointer to the VF info 1771 * @msg: pointer to the msg buffer 1772 * @msglen: msg length 1773 * 1774 * called from the VF to disable all or specific 1775 * queue(s) 1776 **/ 1777 static int i40e_vc_disable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1778 { 1779 struct i40e_virtchnl_queue_select *vqs = 1780 (struct i40e_virtchnl_queue_select *)msg; 1781 struct i40e_pf *pf = vf->pf; 1782 i40e_status aq_ret = 0; 1783 1784 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 1785 aq_ret = I40E_ERR_PARAM; 1786 goto error_param; 1787 } 1788 1789 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) { 1790 aq_ret = I40E_ERR_PARAM; 1791 goto error_param; 1792 } 1793 1794 if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) { 1795 aq_ret = I40E_ERR_PARAM; 1796 goto error_param; 1797 } 1798 1799 if (i40e_vsi_control_rings(pf->vsi[vf->lan_vsi_idx], false)) 1800 aq_ret = I40E_ERR_TIMEOUT; 1801 1802 error_param: 1803 /* send the response to the VF */ 1804 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DISABLE_QUEUES, 1805 aq_ret); 1806 } 1807 1808 /** 1809 * i40e_vc_get_stats_msg 1810 * @vf: pointer to the VF info 1811 * @msg: pointer to the msg buffer 1812 * @msglen: msg length 1813 * 1814 * called from the VF to get vsi stats 1815 **/ 1816 static int i40e_vc_get_stats_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1817 { 1818 struct i40e_virtchnl_queue_select *vqs = 1819 (struct i40e_virtchnl_queue_select *)msg; 1820 struct i40e_pf *pf = vf->pf; 1821 struct i40e_eth_stats stats; 1822 i40e_status aq_ret = 0; 1823 struct i40e_vsi *vsi; 1824 1825 memset(&stats, 0, sizeof(struct i40e_eth_stats)); 1826 1827 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 1828 aq_ret = I40E_ERR_PARAM; 1829 goto error_param; 1830 } 1831 1832 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) { 1833 aq_ret = I40E_ERR_PARAM; 1834 goto error_param; 1835 } 1836 1837 vsi = pf->vsi[vf->lan_vsi_idx]; 1838 if (!vsi) { 1839 aq_ret = I40E_ERR_PARAM; 1840 goto error_param; 1841 } 1842 i40e_update_eth_stats(vsi); 1843 stats = vsi->eth_stats; 1844 1845 error_param: 1846 /* send the response back to the VF */ 1847 return i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_GET_STATS, aq_ret, 1848 (u8 *)&stats, sizeof(stats)); 1849 } 1850 1851 /* If the VF is not trusted restrict the number of MAC/VLAN it can program */ 1852 #define I40E_VC_MAX_MAC_ADDR_PER_VF 8 1853 #define I40E_VC_MAX_VLAN_PER_VF 8 1854 1855 /** 1856 * i40e_check_vf_permission 1857 * @vf: pointer to the VF info 1858 * @macaddr: pointer to the MAC Address being checked 1859 * 1860 * Check if the VF has permission to add or delete unicast MAC address 1861 * filters and return error code -EPERM if not. Then check if the 1862 * address filter requested is broadcast or zero and if so return 1863 * an invalid MAC address error code. 1864 **/ 1865 static inline int i40e_check_vf_permission(struct i40e_vf *vf, u8 *macaddr) 1866 { 1867 struct i40e_pf *pf = vf->pf; 1868 int ret = 0; 1869 1870 if (is_broadcast_ether_addr(macaddr) || 1871 is_zero_ether_addr(macaddr)) { 1872 dev_err(&pf->pdev->dev, "invalid VF MAC addr %pM\n", macaddr); 1873 ret = I40E_ERR_INVALID_MAC_ADDR; 1874 } else if (vf->pf_set_mac && !is_multicast_ether_addr(macaddr) && 1875 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) && 1876 !ether_addr_equal(macaddr, vf->default_lan_addr.addr)) { 1877 /* If the host VMM administrator has set the VF MAC address 1878 * administratively via the ndo_set_vf_mac command then deny 1879 * permission to the VF to add or delete unicast MAC addresses. 1880 * Unless the VF is privileged and then it can do whatever. 1881 * The VF may request to set the MAC address filter already 1882 * assigned to it so do not return an error in that case. 1883 */ 1884 dev_err(&pf->pdev->dev, 1885 "VF attempting to override administratively set MAC address, reload the VF driver to resume normal operation\n"); 1886 ret = -EPERM; 1887 } else if ((vf->num_mac >= I40E_VC_MAX_MAC_ADDR_PER_VF) && 1888 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 1889 dev_err(&pf->pdev->dev, 1890 "VF is not trusted, switch the VF to trusted to add more functionality\n"); 1891 ret = -EPERM; 1892 } 1893 return ret; 1894 } 1895 1896 /** 1897 * i40e_vc_add_mac_addr_msg 1898 * @vf: pointer to the VF info 1899 * @msg: pointer to the msg buffer 1900 * @msglen: msg length 1901 * 1902 * add guest mac address filter 1903 **/ 1904 static int i40e_vc_add_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1905 { 1906 struct i40e_virtchnl_ether_addr_list *al = 1907 (struct i40e_virtchnl_ether_addr_list *)msg; 1908 struct i40e_pf *pf = vf->pf; 1909 struct i40e_vsi *vsi = NULL; 1910 u16 vsi_id = al->vsi_id; 1911 i40e_status ret = 0; 1912 int i; 1913 1914 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 1915 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 1916 ret = I40E_ERR_PARAM; 1917 goto error_param; 1918 } 1919 1920 for (i = 0; i < al->num_elements; i++) { 1921 ret = i40e_check_vf_permission(vf, al->list[i].addr); 1922 if (ret) 1923 goto error_param; 1924 } 1925 vsi = pf->vsi[vf->lan_vsi_idx]; 1926 1927 /* Lock once, because all function inside for loop accesses VSI's 1928 * MAC filter list which needs to be protected using same lock. 1929 */ 1930 spin_lock_bh(&vsi->mac_filter_list_lock); 1931 1932 /* add new addresses to the list */ 1933 for (i = 0; i < al->num_elements; i++) { 1934 struct i40e_mac_filter *f; 1935 1936 f = i40e_find_mac(vsi, al->list[i].addr, true, false); 1937 if (!f) { 1938 if (i40e_is_vsi_in_vlan(vsi)) 1939 f = i40e_put_mac_in_vlan(vsi, al->list[i].addr, 1940 true, false); 1941 else 1942 f = i40e_add_filter(vsi, al->list[i].addr, -1, 1943 true, false); 1944 } 1945 1946 if (!f) { 1947 dev_err(&pf->pdev->dev, 1948 "Unable to add MAC filter %pM for VF %d\n", 1949 al->list[i].addr, vf->vf_id); 1950 ret = I40E_ERR_PARAM; 1951 spin_unlock_bh(&vsi->mac_filter_list_lock); 1952 goto error_param; 1953 } else { 1954 vf->num_mac++; 1955 } 1956 } 1957 spin_unlock_bh(&vsi->mac_filter_list_lock); 1958 1959 /* program the updated filter list */ 1960 ret = i40e_sync_vsi_filters(vsi); 1961 if (ret) 1962 dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n", 1963 vf->vf_id, ret); 1964 1965 error_param: 1966 /* send the response to the VF */ 1967 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS, 1968 ret); 1969 } 1970 1971 /** 1972 * i40e_vc_del_mac_addr_msg 1973 * @vf: pointer to the VF info 1974 * @msg: pointer to the msg buffer 1975 * @msglen: msg length 1976 * 1977 * remove guest mac address filter 1978 **/ 1979 static int i40e_vc_del_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 1980 { 1981 struct i40e_virtchnl_ether_addr_list *al = 1982 (struct i40e_virtchnl_ether_addr_list *)msg; 1983 struct i40e_pf *pf = vf->pf; 1984 struct i40e_vsi *vsi = NULL; 1985 u16 vsi_id = al->vsi_id; 1986 i40e_status ret = 0; 1987 int i; 1988 1989 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 1990 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 1991 ret = I40E_ERR_PARAM; 1992 goto error_param; 1993 } 1994 1995 for (i = 0; i < al->num_elements; i++) { 1996 if (is_broadcast_ether_addr(al->list[i].addr) || 1997 is_zero_ether_addr(al->list[i].addr)) { 1998 dev_err(&pf->pdev->dev, "Invalid MAC addr %pM for VF %d\n", 1999 al->list[i].addr, vf->vf_id); 2000 ret = I40E_ERR_INVALID_MAC_ADDR; 2001 goto error_param; 2002 } 2003 } 2004 vsi = pf->vsi[vf->lan_vsi_idx]; 2005 2006 spin_lock_bh(&vsi->mac_filter_list_lock); 2007 /* delete addresses from the list */ 2008 for (i = 0; i < al->num_elements; i++) 2009 if (i40e_del_mac_all_vlan(vsi, al->list[i].addr, true, false)) { 2010 ret = I40E_ERR_INVALID_MAC_ADDR; 2011 spin_unlock_bh(&vsi->mac_filter_list_lock); 2012 goto error_param; 2013 } else { 2014 vf->num_mac--; 2015 } 2016 2017 spin_unlock_bh(&vsi->mac_filter_list_lock); 2018 2019 /* program the updated filter list */ 2020 ret = i40e_sync_vsi_filters(vsi); 2021 if (ret) 2022 dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n", 2023 vf->vf_id, ret); 2024 2025 error_param: 2026 /* send the response to the VF */ 2027 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS, 2028 ret); 2029 } 2030 2031 /** 2032 * i40e_vc_add_vlan_msg 2033 * @vf: pointer to the VF info 2034 * @msg: pointer to the msg buffer 2035 * @msglen: msg length 2036 * 2037 * program guest vlan id 2038 **/ 2039 static int i40e_vc_add_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 2040 { 2041 struct i40e_virtchnl_vlan_filter_list *vfl = 2042 (struct i40e_virtchnl_vlan_filter_list *)msg; 2043 struct i40e_pf *pf = vf->pf; 2044 struct i40e_vsi *vsi = NULL; 2045 u16 vsi_id = vfl->vsi_id; 2046 i40e_status aq_ret = 0; 2047 int i; 2048 2049 if ((vf->num_vlan >= I40E_VC_MAX_VLAN_PER_VF) && 2050 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 2051 dev_err(&pf->pdev->dev, 2052 "VF is not trusted, switch the VF to trusted to add more VLAN addresses\n"); 2053 goto error_param; 2054 } 2055 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2056 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 2057 aq_ret = I40E_ERR_PARAM; 2058 goto error_param; 2059 } 2060 2061 for (i = 0; i < vfl->num_elements; i++) { 2062 if (vfl->vlan_id[i] > I40E_MAX_VLANID) { 2063 aq_ret = I40E_ERR_PARAM; 2064 dev_err(&pf->pdev->dev, 2065 "invalid VF VLAN id %d\n", vfl->vlan_id[i]); 2066 goto error_param; 2067 } 2068 } 2069 vsi = pf->vsi[vf->lan_vsi_idx]; 2070 if (vsi->info.pvid) { 2071 aq_ret = I40E_ERR_PARAM; 2072 goto error_param; 2073 } 2074 2075 i40e_vlan_stripping_enable(vsi); 2076 for (i = 0; i < vfl->num_elements; i++) { 2077 /* add new VLAN filter */ 2078 int ret = i40e_vsi_add_vlan(vsi, vfl->vlan_id[i]); 2079 if (!ret) 2080 vf->num_vlan++; 2081 2082 if (test_bit(I40E_VF_STAT_UC_PROMISC, &vf->vf_states)) 2083 i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid, 2084 true, 2085 vfl->vlan_id[i], 2086 NULL); 2087 if (test_bit(I40E_VF_STAT_MC_PROMISC, &vf->vf_states)) 2088 i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid, 2089 true, 2090 vfl->vlan_id[i], 2091 NULL); 2092 2093 if (ret) 2094 dev_err(&pf->pdev->dev, 2095 "Unable to add VLAN filter %d for VF %d, error %d\n", 2096 vfl->vlan_id[i], vf->vf_id, ret); 2097 } 2098 2099 error_param: 2100 /* send the response to the VF */ 2101 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_ADD_VLAN, aq_ret); 2102 } 2103 2104 /** 2105 * i40e_vc_remove_vlan_msg 2106 * @vf: pointer to the VF info 2107 * @msg: pointer to the msg buffer 2108 * @msglen: msg length 2109 * 2110 * remove programmed guest vlan id 2111 **/ 2112 static int i40e_vc_remove_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 2113 { 2114 struct i40e_virtchnl_vlan_filter_list *vfl = 2115 (struct i40e_virtchnl_vlan_filter_list *)msg; 2116 struct i40e_pf *pf = vf->pf; 2117 struct i40e_vsi *vsi = NULL; 2118 u16 vsi_id = vfl->vsi_id; 2119 i40e_status aq_ret = 0; 2120 int i; 2121 2122 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2123 !i40e_vc_isvalid_vsi_id(vf, vsi_id)) { 2124 aq_ret = I40E_ERR_PARAM; 2125 goto error_param; 2126 } 2127 2128 for (i = 0; i < vfl->num_elements; i++) { 2129 if (vfl->vlan_id[i] > I40E_MAX_VLANID) { 2130 aq_ret = I40E_ERR_PARAM; 2131 goto error_param; 2132 } 2133 } 2134 2135 vsi = pf->vsi[vf->lan_vsi_idx]; 2136 if (vsi->info.pvid) { 2137 aq_ret = I40E_ERR_PARAM; 2138 goto error_param; 2139 } 2140 2141 for (i = 0; i < vfl->num_elements; i++) { 2142 int ret = i40e_vsi_kill_vlan(vsi, vfl->vlan_id[i]); 2143 if (!ret) 2144 vf->num_vlan--; 2145 2146 if (test_bit(I40E_VF_STAT_UC_PROMISC, &vf->vf_states)) 2147 i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid, 2148 false, 2149 vfl->vlan_id[i], 2150 NULL); 2151 if (test_bit(I40E_VF_STAT_MC_PROMISC, &vf->vf_states)) 2152 i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid, 2153 false, 2154 vfl->vlan_id[i], 2155 NULL); 2156 2157 if (ret) 2158 dev_err(&pf->pdev->dev, 2159 "Unable to delete VLAN filter %d for VF %d, error %d\n", 2160 vfl->vlan_id[i], vf->vf_id, ret); 2161 } 2162 2163 error_param: 2164 /* send the response to the VF */ 2165 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_DEL_VLAN, aq_ret); 2166 } 2167 2168 /** 2169 * i40e_vc_iwarp_msg 2170 * @vf: pointer to the VF info 2171 * @msg: pointer to the msg buffer 2172 * @msglen: msg length 2173 * 2174 * called from the VF for the iwarp msgs 2175 **/ 2176 static int i40e_vc_iwarp_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 2177 { 2178 struct i40e_pf *pf = vf->pf; 2179 int abs_vf_id = vf->vf_id + pf->hw.func_caps.vf_base_id; 2180 i40e_status aq_ret = 0; 2181 2182 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2183 !test_bit(I40E_VF_STAT_IWARPENA, &vf->vf_states)) { 2184 aq_ret = I40E_ERR_PARAM; 2185 goto error_param; 2186 } 2187 2188 i40e_notify_client_of_vf_msg(pf->vsi[pf->lan_vsi], abs_vf_id, 2189 msg, msglen); 2190 2191 error_param: 2192 /* send the response to the VF */ 2193 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_IWARP, 2194 aq_ret); 2195 } 2196 2197 /** 2198 * i40e_vc_iwarp_qvmap_msg 2199 * @vf: pointer to the VF info 2200 * @msg: pointer to the msg buffer 2201 * @msglen: msg length 2202 * @config: config qvmap or release it 2203 * 2204 * called from the VF for the iwarp msgs 2205 **/ 2206 static int i40e_vc_iwarp_qvmap_msg(struct i40e_vf *vf, u8 *msg, u16 msglen, 2207 bool config) 2208 { 2209 struct i40e_virtchnl_iwarp_qvlist_info *qvlist_info = 2210 (struct i40e_virtchnl_iwarp_qvlist_info *)msg; 2211 i40e_status aq_ret = 0; 2212 2213 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2214 !test_bit(I40E_VF_STAT_IWARPENA, &vf->vf_states)) { 2215 aq_ret = I40E_ERR_PARAM; 2216 goto error_param; 2217 } 2218 2219 if (config) { 2220 if (i40e_config_iwarp_qvlist(vf, qvlist_info)) 2221 aq_ret = I40E_ERR_PARAM; 2222 } else { 2223 i40e_release_iwarp_qvlist(vf); 2224 } 2225 2226 error_param: 2227 /* send the response to the VF */ 2228 return i40e_vc_send_resp_to_vf(vf, 2229 config ? I40E_VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP : 2230 I40E_VIRTCHNL_OP_RELEASE_IWARP_IRQ_MAP, 2231 aq_ret); 2232 } 2233 2234 /** 2235 * i40e_vc_config_rss_key 2236 * @vf: pointer to the VF info 2237 * @msg: pointer to the msg buffer 2238 * @msglen: msg length 2239 * 2240 * Configure the VF's RSS key 2241 **/ 2242 static int i40e_vc_config_rss_key(struct i40e_vf *vf, u8 *msg, u16 msglen) 2243 { 2244 struct i40e_virtchnl_rss_key *vrk = 2245 (struct i40e_virtchnl_rss_key *)msg; 2246 struct i40e_pf *pf = vf->pf; 2247 struct i40e_vsi *vsi = NULL; 2248 u16 vsi_id = vrk->vsi_id; 2249 i40e_status aq_ret = 0; 2250 2251 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2252 !i40e_vc_isvalid_vsi_id(vf, vsi_id) || 2253 (vrk->key_len != I40E_HKEY_ARRAY_SIZE)) { 2254 aq_ret = I40E_ERR_PARAM; 2255 goto err; 2256 } 2257 2258 vsi = pf->vsi[vf->lan_vsi_idx]; 2259 aq_ret = i40e_config_rss(vsi, vrk->key, NULL, 0); 2260 err: 2261 /* send the response to the VF */ 2262 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_RSS_KEY, 2263 aq_ret); 2264 } 2265 2266 /** 2267 * i40e_vc_config_rss_lut 2268 * @vf: pointer to the VF info 2269 * @msg: pointer to the msg buffer 2270 * @msglen: msg length 2271 * 2272 * Configure the VF's RSS LUT 2273 **/ 2274 static int i40e_vc_config_rss_lut(struct i40e_vf *vf, u8 *msg, u16 msglen) 2275 { 2276 struct i40e_virtchnl_rss_lut *vrl = 2277 (struct i40e_virtchnl_rss_lut *)msg; 2278 struct i40e_pf *pf = vf->pf; 2279 struct i40e_vsi *vsi = NULL; 2280 u16 vsi_id = vrl->vsi_id; 2281 i40e_status aq_ret = 0; 2282 2283 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states) || 2284 !i40e_vc_isvalid_vsi_id(vf, vsi_id) || 2285 (vrl->lut_entries != I40E_VF_HLUT_ARRAY_SIZE)) { 2286 aq_ret = I40E_ERR_PARAM; 2287 goto err; 2288 } 2289 2290 vsi = pf->vsi[vf->lan_vsi_idx]; 2291 aq_ret = i40e_config_rss(vsi, NULL, vrl->lut, I40E_VF_HLUT_ARRAY_SIZE); 2292 /* send the response to the VF */ 2293 err: 2294 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_CONFIG_RSS_LUT, 2295 aq_ret); 2296 } 2297 2298 /** 2299 * i40e_vc_get_rss_hena 2300 * @vf: pointer to the VF info 2301 * @msg: pointer to the msg buffer 2302 * @msglen: msg length 2303 * 2304 * Return the RSS HENA bits allowed by the hardware 2305 **/ 2306 static int i40e_vc_get_rss_hena(struct i40e_vf *vf, u8 *msg, u16 msglen) 2307 { 2308 struct i40e_virtchnl_rss_hena *vrh = NULL; 2309 struct i40e_pf *pf = vf->pf; 2310 i40e_status aq_ret = 0; 2311 int len = 0; 2312 2313 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 2314 aq_ret = I40E_ERR_PARAM; 2315 goto err; 2316 } 2317 len = sizeof(struct i40e_virtchnl_rss_hena); 2318 2319 vrh = kzalloc(len, GFP_KERNEL); 2320 if (!vrh) { 2321 aq_ret = I40E_ERR_NO_MEMORY; 2322 len = 0; 2323 goto err; 2324 } 2325 vrh->hena = i40e_pf_get_default_rss_hena(pf); 2326 err: 2327 /* send the response back to the VF */ 2328 aq_ret = i40e_vc_send_msg_to_vf(vf, I40E_VIRTCHNL_OP_GET_RSS_HENA_CAPS, 2329 aq_ret, (u8 *)vrh, len); 2330 kfree(vrh); 2331 return aq_ret; 2332 } 2333 2334 /** 2335 * i40e_vc_set_rss_hena 2336 * @vf: pointer to the VF info 2337 * @msg: pointer to the msg buffer 2338 * @msglen: msg length 2339 * 2340 * Set the RSS HENA bits for the VF 2341 **/ 2342 static int i40e_vc_set_rss_hena(struct i40e_vf *vf, u8 *msg, u16 msglen) 2343 { 2344 struct i40e_virtchnl_rss_hena *vrh = 2345 (struct i40e_virtchnl_rss_hena *)msg; 2346 struct i40e_pf *pf = vf->pf; 2347 struct i40e_hw *hw = &pf->hw; 2348 i40e_status aq_ret = 0; 2349 2350 if (!test_bit(I40E_VF_STAT_ACTIVE, &vf->vf_states)) { 2351 aq_ret = I40E_ERR_PARAM; 2352 goto err; 2353 } 2354 i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(0, vf->vf_id), (u32)vrh->hena); 2355 i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(1, vf->vf_id), 2356 (u32)(vrh->hena >> 32)); 2357 2358 /* send the response to the VF */ 2359 err: 2360 return i40e_vc_send_resp_to_vf(vf, I40E_VIRTCHNL_OP_SET_RSS_HENA, 2361 aq_ret); 2362 } 2363 2364 /** 2365 * i40e_vc_validate_vf_msg 2366 * @vf: pointer to the VF info 2367 * @msg: pointer to the msg buffer 2368 * @msglen: msg length 2369 * @msghndl: msg handle 2370 * 2371 * validate msg 2372 **/ 2373 static int i40e_vc_validate_vf_msg(struct i40e_vf *vf, u32 v_opcode, 2374 u32 v_retval, u8 *msg, u16 msglen) 2375 { 2376 bool err_msg_format = false; 2377 int valid_len = 0; 2378 2379 /* Check if VF is disabled. */ 2380 if (test_bit(I40E_VF_STAT_DISABLED, &vf->vf_states)) 2381 return I40E_ERR_PARAM; 2382 2383 /* Validate message length. */ 2384 switch (v_opcode) { 2385 case I40E_VIRTCHNL_OP_VERSION: 2386 valid_len = sizeof(struct i40e_virtchnl_version_info); 2387 break; 2388 case I40E_VIRTCHNL_OP_RESET_VF: 2389 break; 2390 case I40E_VIRTCHNL_OP_GET_VF_RESOURCES: 2391 if (VF_IS_V11(vf)) 2392 valid_len = sizeof(u32); 2393 break; 2394 case I40E_VIRTCHNL_OP_CONFIG_TX_QUEUE: 2395 valid_len = sizeof(struct i40e_virtchnl_txq_info); 2396 break; 2397 case I40E_VIRTCHNL_OP_CONFIG_RX_QUEUE: 2398 valid_len = sizeof(struct i40e_virtchnl_rxq_info); 2399 break; 2400 case I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES: 2401 valid_len = sizeof(struct i40e_virtchnl_vsi_queue_config_info); 2402 if (msglen >= valid_len) { 2403 struct i40e_virtchnl_vsi_queue_config_info *vqc = 2404 (struct i40e_virtchnl_vsi_queue_config_info *)msg; 2405 valid_len += (vqc->num_queue_pairs * 2406 sizeof(struct 2407 i40e_virtchnl_queue_pair_info)); 2408 if (vqc->num_queue_pairs == 0) 2409 err_msg_format = true; 2410 } 2411 break; 2412 case I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP: 2413 valid_len = sizeof(struct i40e_virtchnl_irq_map_info); 2414 if (msglen >= valid_len) { 2415 struct i40e_virtchnl_irq_map_info *vimi = 2416 (struct i40e_virtchnl_irq_map_info *)msg; 2417 valid_len += (vimi->num_vectors * 2418 sizeof(struct i40e_virtchnl_vector_map)); 2419 if (vimi->num_vectors == 0) 2420 err_msg_format = true; 2421 } 2422 break; 2423 case I40E_VIRTCHNL_OP_ENABLE_QUEUES: 2424 case I40E_VIRTCHNL_OP_DISABLE_QUEUES: 2425 valid_len = sizeof(struct i40e_virtchnl_queue_select); 2426 break; 2427 case I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS: 2428 case I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS: 2429 valid_len = sizeof(struct i40e_virtchnl_ether_addr_list); 2430 if (msglen >= valid_len) { 2431 struct i40e_virtchnl_ether_addr_list *veal = 2432 (struct i40e_virtchnl_ether_addr_list *)msg; 2433 valid_len += veal->num_elements * 2434 sizeof(struct i40e_virtchnl_ether_addr); 2435 if (veal->num_elements == 0) 2436 err_msg_format = true; 2437 } 2438 break; 2439 case I40E_VIRTCHNL_OP_ADD_VLAN: 2440 case I40E_VIRTCHNL_OP_DEL_VLAN: 2441 valid_len = sizeof(struct i40e_virtchnl_vlan_filter_list); 2442 if (msglen >= valid_len) { 2443 struct i40e_virtchnl_vlan_filter_list *vfl = 2444 (struct i40e_virtchnl_vlan_filter_list *)msg; 2445 valid_len += vfl->num_elements * sizeof(u16); 2446 if (vfl->num_elements == 0) 2447 err_msg_format = true; 2448 } 2449 break; 2450 case I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE: 2451 valid_len = sizeof(struct i40e_virtchnl_promisc_info); 2452 break; 2453 case I40E_VIRTCHNL_OP_GET_STATS: 2454 valid_len = sizeof(struct i40e_virtchnl_queue_select); 2455 break; 2456 case I40E_VIRTCHNL_OP_IWARP: 2457 /* These messages are opaque to us and will be validated in 2458 * the RDMA client code. We just need to check for nonzero 2459 * length. The firmware will enforce max length restrictions. 2460 */ 2461 if (msglen) 2462 valid_len = msglen; 2463 else 2464 err_msg_format = true; 2465 break; 2466 case I40E_VIRTCHNL_OP_RELEASE_IWARP_IRQ_MAP: 2467 valid_len = 0; 2468 break; 2469 case I40E_VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP: 2470 valid_len = sizeof(struct i40e_virtchnl_iwarp_qvlist_info); 2471 if (msglen >= valid_len) { 2472 struct i40e_virtchnl_iwarp_qvlist_info *qv = 2473 (struct i40e_virtchnl_iwarp_qvlist_info *)msg; 2474 if (qv->num_vectors == 0) { 2475 err_msg_format = true; 2476 break; 2477 } 2478 valid_len += ((qv->num_vectors - 1) * 2479 sizeof(struct i40e_virtchnl_iwarp_qv_info)); 2480 } 2481 break; 2482 case I40E_VIRTCHNL_OP_CONFIG_RSS_KEY: 2483 valid_len = sizeof(struct i40e_virtchnl_rss_key); 2484 if (msglen >= valid_len) { 2485 struct i40e_virtchnl_rss_key *vrk = 2486 (struct i40e_virtchnl_rss_key *)msg; 2487 if (vrk->key_len != I40E_HKEY_ARRAY_SIZE) { 2488 err_msg_format = true; 2489 break; 2490 } 2491 valid_len += vrk->key_len - 1; 2492 } 2493 break; 2494 case I40E_VIRTCHNL_OP_CONFIG_RSS_LUT: 2495 valid_len = sizeof(struct i40e_virtchnl_rss_lut); 2496 if (msglen >= valid_len) { 2497 struct i40e_virtchnl_rss_lut *vrl = 2498 (struct i40e_virtchnl_rss_lut *)msg; 2499 if (vrl->lut_entries != I40E_VF_HLUT_ARRAY_SIZE) { 2500 err_msg_format = true; 2501 break; 2502 } 2503 valid_len += vrl->lut_entries - 1; 2504 } 2505 break; 2506 case I40E_VIRTCHNL_OP_GET_RSS_HENA_CAPS: 2507 break; 2508 case I40E_VIRTCHNL_OP_SET_RSS_HENA: 2509 valid_len = sizeof(struct i40e_virtchnl_rss_hena); 2510 break; 2511 /* These are always errors coming from the VF. */ 2512 case I40E_VIRTCHNL_OP_EVENT: 2513 case I40E_VIRTCHNL_OP_UNKNOWN: 2514 default: 2515 return -EPERM; 2516 } 2517 /* few more checks */ 2518 if ((valid_len != msglen) || (err_msg_format)) { 2519 i40e_vc_send_resp_to_vf(vf, v_opcode, I40E_ERR_PARAM); 2520 return -EINVAL; 2521 } else { 2522 return 0; 2523 } 2524 } 2525 2526 /** 2527 * i40e_vc_process_vf_msg 2528 * @pf: pointer to the PF structure 2529 * @vf_id: source VF id 2530 * @msg: pointer to the msg buffer 2531 * @msglen: msg length 2532 * @msghndl: msg handle 2533 * 2534 * called from the common aeq/arq handler to 2535 * process request from VF 2536 **/ 2537 int i40e_vc_process_vf_msg(struct i40e_pf *pf, s16 vf_id, u32 v_opcode, 2538 u32 v_retval, u8 *msg, u16 msglen) 2539 { 2540 struct i40e_hw *hw = &pf->hw; 2541 int local_vf_id = vf_id - (s16)hw->func_caps.vf_base_id; 2542 struct i40e_vf *vf; 2543 int ret; 2544 2545 pf->vf_aq_requests++; 2546 if (local_vf_id >= pf->num_alloc_vfs) 2547 return -EINVAL; 2548 vf = &(pf->vf[local_vf_id]); 2549 /* perform basic checks on the msg */ 2550 ret = i40e_vc_validate_vf_msg(vf, v_opcode, v_retval, msg, msglen); 2551 2552 if (ret) { 2553 dev_err(&pf->pdev->dev, "Invalid message from VF %d, opcode %d, len %d\n", 2554 local_vf_id, v_opcode, msglen); 2555 return ret; 2556 } 2557 2558 switch (v_opcode) { 2559 case I40E_VIRTCHNL_OP_VERSION: 2560 ret = i40e_vc_get_version_msg(vf, msg); 2561 break; 2562 case I40E_VIRTCHNL_OP_GET_VF_RESOURCES: 2563 ret = i40e_vc_get_vf_resources_msg(vf, msg); 2564 break; 2565 case I40E_VIRTCHNL_OP_RESET_VF: 2566 i40e_vc_reset_vf_msg(vf); 2567 ret = 0; 2568 break; 2569 case I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE: 2570 ret = i40e_vc_config_promiscuous_mode_msg(vf, msg, msglen); 2571 break; 2572 case I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES: 2573 ret = i40e_vc_config_queues_msg(vf, msg, msglen); 2574 break; 2575 case I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP: 2576 ret = i40e_vc_config_irq_map_msg(vf, msg, msglen); 2577 break; 2578 case I40E_VIRTCHNL_OP_ENABLE_QUEUES: 2579 ret = i40e_vc_enable_queues_msg(vf, msg, msglen); 2580 i40e_vc_notify_vf_link_state(vf); 2581 break; 2582 case I40E_VIRTCHNL_OP_DISABLE_QUEUES: 2583 ret = i40e_vc_disable_queues_msg(vf, msg, msglen); 2584 break; 2585 case I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS: 2586 ret = i40e_vc_add_mac_addr_msg(vf, msg, msglen); 2587 break; 2588 case I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS: 2589 ret = i40e_vc_del_mac_addr_msg(vf, msg, msglen); 2590 break; 2591 case I40E_VIRTCHNL_OP_ADD_VLAN: 2592 ret = i40e_vc_add_vlan_msg(vf, msg, msglen); 2593 break; 2594 case I40E_VIRTCHNL_OP_DEL_VLAN: 2595 ret = i40e_vc_remove_vlan_msg(vf, msg, msglen); 2596 break; 2597 case I40E_VIRTCHNL_OP_GET_STATS: 2598 ret = i40e_vc_get_stats_msg(vf, msg, msglen); 2599 break; 2600 case I40E_VIRTCHNL_OP_IWARP: 2601 ret = i40e_vc_iwarp_msg(vf, msg, msglen); 2602 break; 2603 case I40E_VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP: 2604 ret = i40e_vc_iwarp_qvmap_msg(vf, msg, msglen, true); 2605 break; 2606 case I40E_VIRTCHNL_OP_RELEASE_IWARP_IRQ_MAP: 2607 ret = i40e_vc_iwarp_qvmap_msg(vf, msg, msglen, false); 2608 break; 2609 case I40E_VIRTCHNL_OP_CONFIG_RSS_KEY: 2610 ret = i40e_vc_config_rss_key(vf, msg, msglen); 2611 break; 2612 case I40E_VIRTCHNL_OP_CONFIG_RSS_LUT: 2613 ret = i40e_vc_config_rss_lut(vf, msg, msglen); 2614 break; 2615 case I40E_VIRTCHNL_OP_GET_RSS_HENA_CAPS: 2616 ret = i40e_vc_get_rss_hena(vf, msg, msglen); 2617 break; 2618 case I40E_VIRTCHNL_OP_SET_RSS_HENA: 2619 ret = i40e_vc_set_rss_hena(vf, msg, msglen); 2620 break; 2621 2622 case I40E_VIRTCHNL_OP_UNKNOWN: 2623 default: 2624 dev_err(&pf->pdev->dev, "Unsupported opcode %d from VF %d\n", 2625 v_opcode, local_vf_id); 2626 ret = i40e_vc_send_resp_to_vf(vf, v_opcode, 2627 I40E_ERR_NOT_IMPLEMENTED); 2628 break; 2629 } 2630 2631 return ret; 2632 } 2633 2634 /** 2635 * i40e_vc_process_vflr_event 2636 * @pf: pointer to the PF structure 2637 * 2638 * called from the vlfr irq handler to 2639 * free up VF resources and state variables 2640 **/ 2641 int i40e_vc_process_vflr_event(struct i40e_pf *pf) 2642 { 2643 struct i40e_hw *hw = &pf->hw; 2644 u32 reg, reg_idx, bit_idx; 2645 struct i40e_vf *vf; 2646 int vf_id; 2647 2648 if (!test_bit(__I40E_VFLR_EVENT_PENDING, &pf->state)) 2649 return 0; 2650 2651 /* Re-enable the VFLR interrupt cause here, before looking for which 2652 * VF got reset. Otherwise, if another VF gets a reset while the 2653 * first one is being processed, that interrupt will be lost, and 2654 * that VF will be stuck in reset forever. 2655 */ 2656 reg = rd32(hw, I40E_PFINT_ICR0_ENA); 2657 reg |= I40E_PFINT_ICR0_ENA_VFLR_MASK; 2658 wr32(hw, I40E_PFINT_ICR0_ENA, reg); 2659 i40e_flush(hw); 2660 2661 clear_bit(__I40E_VFLR_EVENT_PENDING, &pf->state); 2662 for (vf_id = 0; vf_id < pf->num_alloc_vfs; vf_id++) { 2663 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32; 2664 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32; 2665 /* read GLGEN_VFLRSTAT register to find out the flr VFs */ 2666 vf = &pf->vf[vf_id]; 2667 reg = rd32(hw, I40E_GLGEN_VFLRSTAT(reg_idx)); 2668 if (reg & BIT(bit_idx)) 2669 /* i40e_reset_vf will clear the bit in GLGEN_VFLRSTAT */ 2670 i40e_reset_vf(vf, true); 2671 } 2672 2673 return 0; 2674 } 2675 2676 /** 2677 * i40e_ndo_set_vf_mac 2678 * @netdev: network interface device structure 2679 * @vf_id: VF identifier 2680 * @mac: mac address 2681 * 2682 * program VF mac address 2683 **/ 2684 int i40e_ndo_set_vf_mac(struct net_device *netdev, int vf_id, u8 *mac) 2685 { 2686 struct i40e_netdev_priv *np = netdev_priv(netdev); 2687 struct i40e_vsi *vsi = np->vsi; 2688 struct i40e_pf *pf = vsi->back; 2689 struct i40e_mac_filter *f; 2690 struct i40e_vf *vf; 2691 int ret = 0; 2692 2693 /* validate the request */ 2694 if (vf_id >= pf->num_alloc_vfs) { 2695 dev_err(&pf->pdev->dev, 2696 "Invalid VF Identifier %d\n", vf_id); 2697 ret = -EINVAL; 2698 goto error_param; 2699 } 2700 2701 vf = &(pf->vf[vf_id]); 2702 vsi = pf->vsi[vf->lan_vsi_idx]; 2703 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 2704 dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n", 2705 vf_id); 2706 ret = -EAGAIN; 2707 goto error_param; 2708 } 2709 2710 if (is_multicast_ether_addr(mac)) { 2711 dev_err(&pf->pdev->dev, 2712 "Invalid Ethernet address %pM for VF %d\n", mac, vf_id); 2713 ret = -EINVAL; 2714 goto error_param; 2715 } 2716 2717 /* Lock once because below invoked function add/del_filter requires 2718 * mac_filter_list_lock to be held 2719 */ 2720 spin_lock_bh(&vsi->mac_filter_list_lock); 2721 2722 /* delete the temporary mac address */ 2723 if (!is_zero_ether_addr(vf->default_lan_addr.addr)) 2724 i40e_del_filter(vsi, vf->default_lan_addr.addr, 2725 vf->port_vlan_id ? vf->port_vlan_id : -1, 2726 true, false); 2727 2728 /* Delete all the filters for this VSI - we're going to kill it 2729 * anyway. 2730 */ 2731 list_for_each_entry(f, &vsi->mac_filter_list, list) 2732 i40e_del_filter(vsi, f->macaddr, f->vlan, true, false); 2733 2734 spin_unlock_bh(&vsi->mac_filter_list_lock); 2735 2736 dev_info(&pf->pdev->dev, "Setting MAC %pM on VF %d\n", mac, vf_id); 2737 /* program mac filter */ 2738 if (i40e_sync_vsi_filters(vsi)) { 2739 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n"); 2740 ret = -EIO; 2741 goto error_param; 2742 } 2743 ether_addr_copy(vf->default_lan_addr.addr, mac); 2744 vf->pf_set_mac = true; 2745 /* Force the VF driver stop so it has to reload with new MAC address */ 2746 i40e_vc_disable_vf(pf, vf); 2747 dev_info(&pf->pdev->dev, "Reload the VF driver to make this change effective.\n"); 2748 2749 error_param: 2750 return ret; 2751 } 2752 2753 /** 2754 * i40e_ndo_set_vf_port_vlan 2755 * @netdev: network interface device structure 2756 * @vf_id: VF identifier 2757 * @vlan_id: mac address 2758 * @qos: priority setting 2759 * @vlan_proto: vlan protocol 2760 * 2761 * program VF vlan id and/or qos 2762 **/ 2763 int i40e_ndo_set_vf_port_vlan(struct net_device *netdev, int vf_id, 2764 u16 vlan_id, u8 qos, __be16 vlan_proto) 2765 { 2766 u16 vlanprio = vlan_id | (qos << I40E_VLAN_PRIORITY_SHIFT); 2767 struct i40e_netdev_priv *np = netdev_priv(netdev); 2768 struct i40e_pf *pf = np->vsi->back; 2769 bool is_vsi_in_vlan = false; 2770 struct i40e_vsi *vsi; 2771 struct i40e_vf *vf; 2772 int ret = 0; 2773 2774 /* validate the request */ 2775 if (vf_id >= pf->num_alloc_vfs) { 2776 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 2777 ret = -EINVAL; 2778 goto error_pvid; 2779 } 2780 2781 if ((vlan_id > I40E_MAX_VLANID) || (qos > 7)) { 2782 dev_err(&pf->pdev->dev, "Invalid VF Parameters\n"); 2783 ret = -EINVAL; 2784 goto error_pvid; 2785 } 2786 2787 if (vlan_proto != htons(ETH_P_8021Q)) { 2788 dev_err(&pf->pdev->dev, "VF VLAN protocol is not supported\n"); 2789 ret = -EPROTONOSUPPORT; 2790 goto error_pvid; 2791 } 2792 2793 vf = &(pf->vf[vf_id]); 2794 vsi = pf->vsi[vf->lan_vsi_idx]; 2795 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 2796 dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n", 2797 vf_id); 2798 ret = -EAGAIN; 2799 goto error_pvid; 2800 } 2801 2802 if (le16_to_cpu(vsi->info.pvid) == vlanprio) 2803 /* duplicate request, so just return success */ 2804 goto error_pvid; 2805 2806 spin_lock_bh(&vsi->mac_filter_list_lock); 2807 is_vsi_in_vlan = i40e_is_vsi_in_vlan(vsi); 2808 spin_unlock_bh(&vsi->mac_filter_list_lock); 2809 2810 if (le16_to_cpu(vsi->info.pvid) == 0 && is_vsi_in_vlan) { 2811 dev_err(&pf->pdev->dev, 2812 "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", 2813 vf_id); 2814 /* Administrator Error - knock the VF offline until he does 2815 * the right thing by reconfiguring his network correctly 2816 * and then reloading the VF driver. 2817 */ 2818 i40e_vc_disable_vf(pf, vf); 2819 /* During reset the VF got a new VSI, so refresh the pointer. */ 2820 vsi = pf->vsi[vf->lan_vsi_idx]; 2821 } 2822 2823 /* Check for condition where there was already a port VLAN ID 2824 * filter set and now it is being deleted by setting it to zero. 2825 * Additionally check for the condition where there was a port 2826 * VLAN but now there is a new and different port VLAN being set. 2827 * Before deleting all the old VLAN filters we must add new ones 2828 * with -1 (I40E_VLAN_ANY) or otherwise we're left with all our 2829 * MAC addresses deleted. 2830 */ 2831 if ((!(vlan_id || qos) || 2832 vlanprio != le16_to_cpu(vsi->info.pvid)) && 2833 vsi->info.pvid) 2834 ret = i40e_vsi_add_vlan(vsi, I40E_VLAN_ANY); 2835 2836 if (vsi->info.pvid) { 2837 /* kill old VLAN */ 2838 ret = i40e_vsi_kill_vlan(vsi, (le16_to_cpu(vsi->info.pvid) & 2839 VLAN_VID_MASK)); 2840 if (ret) { 2841 dev_info(&vsi->back->pdev->dev, 2842 "remove VLAN failed, ret=%d, aq_err=%d\n", 2843 ret, pf->hw.aq.asq_last_status); 2844 } 2845 } 2846 if (vlan_id || qos) 2847 ret = i40e_vsi_add_pvid(vsi, vlanprio); 2848 else 2849 i40e_vsi_remove_pvid(vsi); 2850 2851 if (vlan_id) { 2852 dev_info(&pf->pdev->dev, "Setting VLAN %d, QOS 0x%x on VF %d\n", 2853 vlan_id, qos, vf_id); 2854 2855 /* add new VLAN filter */ 2856 ret = i40e_vsi_add_vlan(vsi, vlan_id); 2857 if (ret) { 2858 dev_info(&vsi->back->pdev->dev, 2859 "add VF VLAN failed, ret=%d aq_err=%d\n", ret, 2860 vsi->back->hw.aq.asq_last_status); 2861 goto error_pvid; 2862 } 2863 /* Kill non-vlan MAC filters - ignore error return since 2864 * there might not be any non-vlan MAC filters. 2865 */ 2866 i40e_vsi_kill_vlan(vsi, I40E_VLAN_ANY); 2867 } 2868 2869 if (ret) { 2870 dev_err(&pf->pdev->dev, "Unable to update VF vsi context\n"); 2871 goto error_pvid; 2872 } 2873 /* The Port VLAN needs to be saved across resets the same as the 2874 * default LAN MAC address. 2875 */ 2876 vf->port_vlan_id = le16_to_cpu(vsi->info.pvid); 2877 ret = 0; 2878 2879 error_pvid: 2880 return ret; 2881 } 2882 2883 #define I40E_BW_CREDIT_DIVISOR 50 /* 50Mbps per BW credit */ 2884 #define I40E_MAX_BW_INACTIVE_ACCUM 4 /* device can accumulate 4 credits max */ 2885 /** 2886 * i40e_ndo_set_vf_bw 2887 * @netdev: network interface device structure 2888 * @vf_id: VF identifier 2889 * @tx_rate: Tx rate 2890 * 2891 * configure VF Tx rate 2892 **/ 2893 int i40e_ndo_set_vf_bw(struct net_device *netdev, int vf_id, int min_tx_rate, 2894 int max_tx_rate) 2895 { 2896 struct i40e_netdev_priv *np = netdev_priv(netdev); 2897 struct i40e_pf *pf = np->vsi->back; 2898 struct i40e_vsi *vsi; 2899 struct i40e_vf *vf; 2900 int speed = 0; 2901 int ret = 0; 2902 2903 /* validate the request */ 2904 if (vf_id >= pf->num_alloc_vfs) { 2905 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d.\n", vf_id); 2906 ret = -EINVAL; 2907 goto error; 2908 } 2909 2910 if (min_tx_rate) { 2911 dev_err(&pf->pdev->dev, "Invalid min tx rate (%d) (greater than 0) specified for VF %d.\n", 2912 min_tx_rate, vf_id); 2913 return -EINVAL; 2914 } 2915 2916 vf = &(pf->vf[vf_id]); 2917 vsi = pf->vsi[vf->lan_vsi_idx]; 2918 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 2919 dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n", 2920 vf_id); 2921 ret = -EAGAIN; 2922 goto error; 2923 } 2924 2925 switch (pf->hw.phy.link_info.link_speed) { 2926 case I40E_LINK_SPEED_40GB: 2927 speed = 40000; 2928 break; 2929 case I40E_LINK_SPEED_20GB: 2930 speed = 20000; 2931 break; 2932 case I40E_LINK_SPEED_10GB: 2933 speed = 10000; 2934 break; 2935 case I40E_LINK_SPEED_1GB: 2936 speed = 1000; 2937 break; 2938 default: 2939 break; 2940 } 2941 2942 if (max_tx_rate > speed) { 2943 dev_err(&pf->pdev->dev, "Invalid max tx rate %d specified for VF %d.", 2944 max_tx_rate, vf->vf_id); 2945 ret = -EINVAL; 2946 goto error; 2947 } 2948 2949 if ((max_tx_rate < 50) && (max_tx_rate > 0)) { 2950 dev_warn(&pf->pdev->dev, "Setting max Tx rate to minimum usable value of 50Mbps.\n"); 2951 max_tx_rate = 50; 2952 } 2953 2954 /* Tx rate credits are in values of 50Mbps, 0 is disabled*/ 2955 ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid, 2956 max_tx_rate / I40E_BW_CREDIT_DIVISOR, 2957 I40E_MAX_BW_INACTIVE_ACCUM, NULL); 2958 if (ret) { 2959 dev_err(&pf->pdev->dev, "Unable to set max tx rate, error code %d.\n", 2960 ret); 2961 ret = -EIO; 2962 goto error; 2963 } 2964 vf->tx_rate = max_tx_rate; 2965 error: 2966 return ret; 2967 } 2968 2969 /** 2970 * i40e_ndo_get_vf_config 2971 * @netdev: network interface device structure 2972 * @vf_id: VF identifier 2973 * @ivi: VF configuration structure 2974 * 2975 * return VF configuration 2976 **/ 2977 int i40e_ndo_get_vf_config(struct net_device *netdev, 2978 int vf_id, struct ifla_vf_info *ivi) 2979 { 2980 struct i40e_netdev_priv *np = netdev_priv(netdev); 2981 struct i40e_vsi *vsi = np->vsi; 2982 struct i40e_pf *pf = vsi->back; 2983 struct i40e_vf *vf; 2984 int ret = 0; 2985 2986 /* validate the request */ 2987 if (vf_id >= pf->num_alloc_vfs) { 2988 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 2989 ret = -EINVAL; 2990 goto error_param; 2991 } 2992 2993 vf = &(pf->vf[vf_id]); 2994 /* first vsi is always the LAN vsi */ 2995 vsi = pf->vsi[vf->lan_vsi_idx]; 2996 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 2997 dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n", 2998 vf_id); 2999 ret = -EAGAIN; 3000 goto error_param; 3001 } 3002 3003 ivi->vf = vf_id; 3004 3005 ether_addr_copy(ivi->mac, vf->default_lan_addr.addr); 3006 3007 ivi->max_tx_rate = vf->tx_rate; 3008 ivi->min_tx_rate = 0; 3009 ivi->vlan = le16_to_cpu(vsi->info.pvid) & I40E_VLAN_MASK; 3010 ivi->qos = (le16_to_cpu(vsi->info.pvid) & I40E_PRIORITY_MASK) >> 3011 I40E_VLAN_PRIORITY_SHIFT; 3012 if (vf->link_forced == false) 3013 ivi->linkstate = IFLA_VF_LINK_STATE_AUTO; 3014 else if (vf->link_up == true) 3015 ivi->linkstate = IFLA_VF_LINK_STATE_ENABLE; 3016 else 3017 ivi->linkstate = IFLA_VF_LINK_STATE_DISABLE; 3018 ivi->spoofchk = vf->spoofchk; 3019 ivi->trusted = vf->trusted; 3020 ret = 0; 3021 3022 error_param: 3023 return ret; 3024 } 3025 3026 /** 3027 * i40e_ndo_set_vf_link_state 3028 * @netdev: network interface device structure 3029 * @vf_id: VF identifier 3030 * @link: required link state 3031 * 3032 * Set the link state of a specified VF, regardless of physical link state 3033 **/ 3034 int i40e_ndo_set_vf_link_state(struct net_device *netdev, int vf_id, int link) 3035 { 3036 struct i40e_netdev_priv *np = netdev_priv(netdev); 3037 struct i40e_pf *pf = np->vsi->back; 3038 struct i40e_virtchnl_pf_event pfe; 3039 struct i40e_hw *hw = &pf->hw; 3040 struct i40e_vf *vf; 3041 int abs_vf_id; 3042 int ret = 0; 3043 3044 /* validate the request */ 3045 if (vf_id >= pf->num_alloc_vfs) { 3046 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 3047 ret = -EINVAL; 3048 goto error_out; 3049 } 3050 3051 vf = &pf->vf[vf_id]; 3052 abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 3053 3054 pfe.event = I40E_VIRTCHNL_EVENT_LINK_CHANGE; 3055 pfe.severity = I40E_PF_EVENT_SEVERITY_INFO; 3056 3057 switch (link) { 3058 case IFLA_VF_LINK_STATE_AUTO: 3059 vf->link_forced = false; 3060 pfe.event_data.link_event.link_status = 3061 pf->hw.phy.link_info.link_info & I40E_AQ_LINK_UP; 3062 pfe.event_data.link_event.link_speed = 3063 pf->hw.phy.link_info.link_speed; 3064 break; 3065 case IFLA_VF_LINK_STATE_ENABLE: 3066 vf->link_forced = true; 3067 vf->link_up = true; 3068 pfe.event_data.link_event.link_status = true; 3069 pfe.event_data.link_event.link_speed = I40E_LINK_SPEED_40GB; 3070 break; 3071 case IFLA_VF_LINK_STATE_DISABLE: 3072 vf->link_forced = true; 3073 vf->link_up = false; 3074 pfe.event_data.link_event.link_status = false; 3075 pfe.event_data.link_event.link_speed = 0; 3076 break; 3077 default: 3078 ret = -EINVAL; 3079 goto error_out; 3080 } 3081 /* Notify the VF of its new link state */ 3082 i40e_aq_send_msg_to_vf(hw, abs_vf_id, I40E_VIRTCHNL_OP_EVENT, 3083 0, (u8 *)&pfe, sizeof(pfe), NULL); 3084 3085 error_out: 3086 return ret; 3087 } 3088 3089 /** 3090 * i40e_ndo_set_vf_spoofchk 3091 * @netdev: network interface device structure 3092 * @vf_id: VF identifier 3093 * @enable: flag to enable or disable feature 3094 * 3095 * Enable or disable VF spoof checking 3096 **/ 3097 int i40e_ndo_set_vf_spoofchk(struct net_device *netdev, int vf_id, bool enable) 3098 { 3099 struct i40e_netdev_priv *np = netdev_priv(netdev); 3100 struct i40e_vsi *vsi = np->vsi; 3101 struct i40e_pf *pf = vsi->back; 3102 struct i40e_vsi_context ctxt; 3103 struct i40e_hw *hw = &pf->hw; 3104 struct i40e_vf *vf; 3105 int ret = 0; 3106 3107 /* validate the request */ 3108 if (vf_id >= pf->num_alloc_vfs) { 3109 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 3110 ret = -EINVAL; 3111 goto out; 3112 } 3113 3114 vf = &(pf->vf[vf_id]); 3115 if (!test_bit(I40E_VF_STAT_INIT, &vf->vf_states)) { 3116 dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n", 3117 vf_id); 3118 ret = -EAGAIN; 3119 goto out; 3120 } 3121 3122 if (enable == vf->spoofchk) 3123 goto out; 3124 3125 vf->spoofchk = enable; 3126 memset(&ctxt, 0, sizeof(ctxt)); 3127 ctxt.seid = pf->vsi[vf->lan_vsi_idx]->seid; 3128 ctxt.pf_num = pf->hw.pf_id; 3129 ctxt.info.valid_sections = cpu_to_le16(I40E_AQ_VSI_PROP_SECURITY_VALID); 3130 if (enable) 3131 ctxt.info.sec_flags |= (I40E_AQ_VSI_SEC_FLAG_ENABLE_VLAN_CHK | 3132 I40E_AQ_VSI_SEC_FLAG_ENABLE_MAC_CHK); 3133 ret = i40e_aq_update_vsi_params(hw, &ctxt, NULL); 3134 if (ret) { 3135 dev_err(&pf->pdev->dev, "Error %d updating VSI parameters\n", 3136 ret); 3137 ret = -EIO; 3138 } 3139 out: 3140 return ret; 3141 } 3142 3143 /** 3144 * i40e_ndo_set_vf_trust 3145 * @netdev: network interface device structure of the pf 3146 * @vf_id: VF identifier 3147 * @setting: trust setting 3148 * 3149 * Enable or disable VF trust setting 3150 **/ 3151 int i40e_ndo_set_vf_trust(struct net_device *netdev, int vf_id, bool setting) 3152 { 3153 struct i40e_netdev_priv *np = netdev_priv(netdev); 3154 struct i40e_pf *pf = np->vsi->back; 3155 struct i40e_vf *vf; 3156 int ret = 0; 3157 3158 /* validate the request */ 3159 if (vf_id >= pf->num_alloc_vfs) { 3160 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 3161 return -EINVAL; 3162 } 3163 3164 if (pf->flags & I40E_FLAG_MFP_ENABLED) { 3165 dev_err(&pf->pdev->dev, "Trusted VF not supported in MFP mode.\n"); 3166 return -EINVAL; 3167 } 3168 3169 vf = &pf->vf[vf_id]; 3170 3171 if (!vf) 3172 return -EINVAL; 3173 if (setting == vf->trusted) 3174 goto out; 3175 3176 vf->trusted = setting; 3177 i40e_vc_notify_vf_reset(vf); 3178 i40e_reset_vf(vf, false); 3179 dev_info(&pf->pdev->dev, "VF %u is now %strusted\n", 3180 vf_id, setting ? "" : "un"); 3181 out: 3182 return ret; 3183 } 3184