1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright(c) 2013 - 2018 Intel Corporation. */ 3 4 #include "i40e.h" 5 6 /*********************notification routines***********************/ 7 8 /** 9 * i40e_vc_vf_broadcast 10 * @pf: pointer to the PF structure 11 * @v_opcode: operation code 12 * @v_retval: return value 13 * @msg: pointer to the msg buffer 14 * @msglen: msg length 15 * 16 * send a message to all VFs on a given PF 17 **/ 18 static void i40e_vc_vf_broadcast(struct i40e_pf *pf, 19 enum virtchnl_ops v_opcode, 20 int v_retval, u8 *msg, 21 u16 msglen) 22 { 23 struct i40e_hw *hw = &pf->hw; 24 struct i40e_vf *vf = pf->vf; 25 int i; 26 27 for (i = 0; i < pf->num_alloc_vfs; i++, vf++) { 28 int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id; 29 /* Not all vfs are enabled so skip the ones that are not */ 30 if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states) && 31 !test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) 32 continue; 33 34 /* Ignore return value on purpose - a given VF may fail, but 35 * we need to keep going and send to all of them 36 */ 37 i40e_aq_send_msg_to_vf(hw, abs_vf_id, v_opcode, v_retval, 38 msg, msglen, NULL); 39 } 40 } 41 42 /** 43 * i40e_vc_link_speed2mbps 44 * converts i40e_aq_link_speed to integer value of Mbps 45 * @link_speed: the speed to convert 46 * 47 * return the speed as direct value of Mbps. 48 **/ 49 static u32 50 i40e_vc_link_speed2mbps(enum i40e_aq_link_speed link_speed) 51 { 52 switch (link_speed) { 53 case I40E_LINK_SPEED_100MB: 54 return SPEED_100; 55 case I40E_LINK_SPEED_1GB: 56 return SPEED_1000; 57 case I40E_LINK_SPEED_2_5GB: 58 return SPEED_2500; 59 case I40E_LINK_SPEED_5GB: 60 return SPEED_5000; 61 case I40E_LINK_SPEED_10GB: 62 return SPEED_10000; 63 case I40E_LINK_SPEED_20GB: 64 return SPEED_20000; 65 case I40E_LINK_SPEED_25GB: 66 return SPEED_25000; 67 case I40E_LINK_SPEED_40GB: 68 return SPEED_40000; 69 case I40E_LINK_SPEED_UNKNOWN: 70 return SPEED_UNKNOWN; 71 } 72 return SPEED_UNKNOWN; 73 } 74 75 /** 76 * i40e_set_vf_link_state 77 * @vf: pointer to the VF structure 78 * @pfe: pointer to PF event structure 79 * @ls: pointer to link status structure 80 * 81 * set a link state on a single vf 82 **/ 83 static void i40e_set_vf_link_state(struct i40e_vf *vf, 84 struct virtchnl_pf_event *pfe, struct i40e_link_status *ls) 85 { 86 u8 link_status = ls->link_info & I40E_AQ_LINK_UP; 87 88 if (vf->link_forced) 89 link_status = vf->link_up; 90 91 if (vf->driver_caps & VIRTCHNL_VF_CAP_ADV_LINK_SPEED) { 92 pfe->event_data.link_event_adv.link_speed = link_status ? 93 i40e_vc_link_speed2mbps(ls->link_speed) : 0; 94 pfe->event_data.link_event_adv.link_status = link_status; 95 } else { 96 pfe->event_data.link_event.link_speed = link_status ? 97 i40e_virtchnl_link_speed(ls->link_speed) : 0; 98 pfe->event_data.link_event.link_status = link_status; 99 } 100 } 101 102 /** 103 * i40e_vc_notify_vf_link_state 104 * @vf: pointer to the VF structure 105 * 106 * send a link status message to a single VF 107 **/ 108 static void i40e_vc_notify_vf_link_state(struct i40e_vf *vf) 109 { 110 struct virtchnl_pf_event pfe; 111 struct i40e_pf *pf = vf->pf; 112 struct i40e_hw *hw = &pf->hw; 113 struct i40e_link_status *ls = &pf->hw.phy.link_info; 114 int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id; 115 116 pfe.event = VIRTCHNL_EVENT_LINK_CHANGE; 117 pfe.severity = PF_EVENT_SEVERITY_INFO; 118 119 i40e_set_vf_link_state(vf, &pfe, ls); 120 121 i40e_aq_send_msg_to_vf(hw, abs_vf_id, VIRTCHNL_OP_EVENT, 122 0, (u8 *)&pfe, sizeof(pfe), NULL); 123 } 124 125 /** 126 * i40e_vc_notify_link_state 127 * @pf: pointer to the PF structure 128 * 129 * send a link status message to all VFs on a given PF 130 **/ 131 void i40e_vc_notify_link_state(struct i40e_pf *pf) 132 { 133 int i; 134 135 for (i = 0; i < pf->num_alloc_vfs; i++) 136 i40e_vc_notify_vf_link_state(&pf->vf[i]); 137 } 138 139 /** 140 * i40e_vc_notify_reset 141 * @pf: pointer to the PF structure 142 * 143 * indicate a pending reset to all VFs on a given PF 144 **/ 145 void i40e_vc_notify_reset(struct i40e_pf *pf) 146 { 147 struct virtchnl_pf_event pfe; 148 149 pfe.event = VIRTCHNL_EVENT_RESET_IMPENDING; 150 pfe.severity = PF_EVENT_SEVERITY_CERTAIN_DOOM; 151 i40e_vc_vf_broadcast(pf, VIRTCHNL_OP_EVENT, 0, 152 (u8 *)&pfe, sizeof(struct virtchnl_pf_event)); 153 } 154 155 #ifdef CONFIG_PCI_IOV 156 void i40e_restore_all_vfs_msi_state(struct pci_dev *pdev) 157 { 158 u16 vf_id; 159 u16 pos; 160 161 /* Continue only if this is a PF */ 162 if (!pdev->is_physfn) 163 return; 164 165 if (!pci_num_vf(pdev)) 166 return; 167 168 pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_SRIOV); 169 if (pos) { 170 struct pci_dev *vf_dev = NULL; 171 172 pci_read_config_word(pdev, pos + PCI_SRIOV_VF_DID, &vf_id); 173 while ((vf_dev = pci_get_device(pdev->vendor, vf_id, vf_dev))) { 174 if (vf_dev->is_virtfn && vf_dev->physfn == pdev) 175 pci_restore_msi_state(vf_dev); 176 } 177 } 178 } 179 #endif /* CONFIG_PCI_IOV */ 180 181 /** 182 * i40e_vc_notify_vf_reset 183 * @vf: pointer to the VF structure 184 * 185 * indicate a pending reset to the given VF 186 **/ 187 void i40e_vc_notify_vf_reset(struct i40e_vf *vf) 188 { 189 struct virtchnl_pf_event pfe; 190 int abs_vf_id; 191 192 /* validate the request */ 193 if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs) 194 return; 195 196 /* verify if the VF is in either init or active before proceeding */ 197 if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states) && 198 !test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) 199 return; 200 201 abs_vf_id = vf->vf_id + (int)vf->pf->hw.func_caps.vf_base_id; 202 203 pfe.event = VIRTCHNL_EVENT_RESET_IMPENDING; 204 pfe.severity = PF_EVENT_SEVERITY_CERTAIN_DOOM; 205 i40e_aq_send_msg_to_vf(&vf->pf->hw, abs_vf_id, VIRTCHNL_OP_EVENT, 206 0, (u8 *)&pfe, 207 sizeof(struct virtchnl_pf_event), NULL); 208 } 209 /***********************misc routines*****************************/ 210 211 /** 212 * i40e_vc_reset_vf 213 * @vf: pointer to the VF info 214 * @notify_vf: notify vf about reset or not 215 * Reset VF handler. 216 **/ 217 static void i40e_vc_reset_vf(struct i40e_vf *vf, bool notify_vf) 218 { 219 struct i40e_pf *pf = vf->pf; 220 int i; 221 222 if (notify_vf) 223 i40e_vc_notify_vf_reset(vf); 224 225 /* We want to ensure that an actual reset occurs initiated after this 226 * function was called. However, we do not want to wait forever, so 227 * we'll give a reasonable time and print a message if we failed to 228 * ensure a reset. 229 */ 230 for (i = 0; i < 20; i++) { 231 /* If PF is in VFs releasing state reset VF is impossible, 232 * so leave it. 233 */ 234 if (test_bit(__I40E_VFS_RELEASING, pf->state)) 235 return; 236 if (i40e_reset_vf(vf, false)) 237 return; 238 usleep_range(10000, 20000); 239 } 240 241 if (notify_vf) 242 dev_warn(&vf->pf->pdev->dev, 243 "Failed to initiate reset for VF %d after 200 milliseconds\n", 244 vf->vf_id); 245 else 246 dev_dbg(&vf->pf->pdev->dev, 247 "Failed to initiate reset for VF %d after 200 milliseconds\n", 248 vf->vf_id); 249 } 250 251 /** 252 * i40e_vc_isvalid_vsi_id 253 * @vf: pointer to the VF info 254 * @vsi_id: VF relative VSI id 255 * 256 * check for the valid VSI id 257 **/ 258 static inline bool i40e_vc_isvalid_vsi_id(struct i40e_vf *vf, u16 vsi_id) 259 { 260 struct i40e_pf *pf = vf->pf; 261 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 262 263 return (vsi && (vsi->vf_id == vf->vf_id)); 264 } 265 266 /** 267 * i40e_vc_isvalid_queue_id 268 * @vf: pointer to the VF info 269 * @vsi_id: vsi id 270 * @qid: vsi relative queue id 271 * 272 * check for the valid queue id 273 **/ 274 static inline bool i40e_vc_isvalid_queue_id(struct i40e_vf *vf, u16 vsi_id, 275 u16 qid) 276 { 277 struct i40e_pf *pf = vf->pf; 278 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 279 280 return (vsi && (qid < vsi->alloc_queue_pairs)); 281 } 282 283 /** 284 * i40e_vc_isvalid_vector_id 285 * @vf: pointer to the VF info 286 * @vector_id: VF relative vector id 287 * 288 * check for the valid vector id 289 **/ 290 static inline bool i40e_vc_isvalid_vector_id(struct i40e_vf *vf, u32 vector_id) 291 { 292 struct i40e_pf *pf = vf->pf; 293 294 return vector_id < pf->hw.func_caps.num_msix_vectors_vf; 295 } 296 297 /***********************vf resource mgmt routines*****************/ 298 299 /** 300 * i40e_vc_get_pf_queue_id 301 * @vf: pointer to the VF info 302 * @vsi_id: id of VSI as provided by the FW 303 * @vsi_queue_id: vsi relative queue id 304 * 305 * return PF relative queue id 306 **/ 307 static u16 i40e_vc_get_pf_queue_id(struct i40e_vf *vf, u16 vsi_id, 308 u8 vsi_queue_id) 309 { 310 struct i40e_pf *pf = vf->pf; 311 struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id); 312 u16 pf_queue_id = I40E_QUEUE_END_OF_LIST; 313 314 if (!vsi) 315 return pf_queue_id; 316 317 if (le16_to_cpu(vsi->info.mapping_flags) & 318 I40E_AQ_VSI_QUE_MAP_NONCONTIG) 319 pf_queue_id = 320 le16_to_cpu(vsi->info.queue_mapping[vsi_queue_id]); 321 else 322 pf_queue_id = le16_to_cpu(vsi->info.queue_mapping[0]) + 323 vsi_queue_id; 324 325 return pf_queue_id; 326 } 327 328 /** 329 * i40e_get_real_pf_qid 330 * @vf: pointer to the VF info 331 * @vsi_id: vsi id 332 * @queue_id: queue number 333 * 334 * wrapper function to get pf_queue_id handling ADq code as well 335 **/ 336 static u16 i40e_get_real_pf_qid(struct i40e_vf *vf, u16 vsi_id, u16 queue_id) 337 { 338 int i; 339 340 if (vf->adq_enabled) { 341 /* Although VF considers all the queues(can be 1 to 16) as its 342 * own but they may actually belong to different VSIs(up to 4). 343 * We need to find which queues belongs to which VSI. 344 */ 345 for (i = 0; i < vf->num_tc; i++) { 346 if (queue_id < vf->ch[i].num_qps) { 347 vsi_id = vf->ch[i].vsi_id; 348 break; 349 } 350 /* find right queue id which is relative to a 351 * given VSI. 352 */ 353 queue_id -= vf->ch[i].num_qps; 354 } 355 } 356 357 return i40e_vc_get_pf_queue_id(vf, vsi_id, queue_id); 358 } 359 360 /** 361 * i40e_config_irq_link_list 362 * @vf: pointer to the VF info 363 * @vsi_id: id of VSI as given by the FW 364 * @vecmap: irq map info 365 * 366 * configure irq link list from the map 367 **/ 368 static void i40e_config_irq_link_list(struct i40e_vf *vf, u16 vsi_id, 369 struct virtchnl_vector_map *vecmap) 370 { 371 unsigned long linklistmap = 0, tempmap; 372 struct i40e_pf *pf = vf->pf; 373 struct i40e_hw *hw = &pf->hw; 374 u16 vsi_queue_id, pf_queue_id; 375 enum i40e_queue_type qtype; 376 u16 next_q, vector_id, size; 377 u32 reg, reg_idx; 378 u16 itr_idx = 0; 379 380 vector_id = vecmap->vector_id; 381 /* setup the head */ 382 if (0 == vector_id) 383 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id); 384 else 385 reg_idx = I40E_VPINT_LNKLSTN( 386 ((pf->hw.func_caps.num_msix_vectors_vf - 1) * vf->vf_id) + 387 (vector_id - 1)); 388 389 if (vecmap->rxq_map == 0 && vecmap->txq_map == 0) { 390 /* Special case - No queues mapped on this vector */ 391 wr32(hw, reg_idx, I40E_VPINT_LNKLST0_FIRSTQ_INDX_MASK); 392 goto irq_list_done; 393 } 394 tempmap = vecmap->rxq_map; 395 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 396 linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES * 397 vsi_queue_id)); 398 } 399 400 tempmap = vecmap->txq_map; 401 for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) { 402 linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES * 403 vsi_queue_id + 1)); 404 } 405 406 size = I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES; 407 next_q = find_first_bit(&linklistmap, size); 408 if (unlikely(next_q == size)) 409 goto irq_list_done; 410 411 vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES; 412 qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES; 413 pf_queue_id = i40e_get_real_pf_qid(vf, vsi_id, vsi_queue_id); 414 reg = ((qtype << I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT) | pf_queue_id); 415 416 wr32(hw, reg_idx, reg); 417 418 while (next_q < size) { 419 switch (qtype) { 420 case I40E_QUEUE_TYPE_RX: 421 reg_idx = I40E_QINT_RQCTL(pf_queue_id); 422 itr_idx = vecmap->rxitr_idx; 423 break; 424 case I40E_QUEUE_TYPE_TX: 425 reg_idx = I40E_QINT_TQCTL(pf_queue_id); 426 itr_idx = vecmap->txitr_idx; 427 break; 428 default: 429 break; 430 } 431 432 next_q = find_next_bit(&linklistmap, size, next_q + 1); 433 if (next_q < size) { 434 vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES; 435 qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES; 436 pf_queue_id = i40e_get_real_pf_qid(vf, 437 vsi_id, 438 vsi_queue_id); 439 } else { 440 pf_queue_id = I40E_QUEUE_END_OF_LIST; 441 qtype = 0; 442 } 443 444 /* format for the RQCTL & TQCTL regs is same */ 445 reg = (vector_id) | 446 (qtype << I40E_QINT_RQCTL_NEXTQ_TYPE_SHIFT) | 447 (pf_queue_id << I40E_QINT_RQCTL_NEXTQ_INDX_SHIFT) | 448 BIT(I40E_QINT_RQCTL_CAUSE_ENA_SHIFT) | 449 (itr_idx << I40E_QINT_RQCTL_ITR_INDX_SHIFT); 450 wr32(hw, reg_idx, reg); 451 } 452 453 /* if the vf is running in polling mode and using interrupt zero, 454 * need to disable auto-mask on enabling zero interrupt for VFs. 455 */ 456 if ((vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_POLLING) && 457 (vector_id == 0)) { 458 reg = rd32(hw, I40E_GLINT_CTL); 459 if (!(reg & I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK)) { 460 reg |= I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK; 461 wr32(hw, I40E_GLINT_CTL, reg); 462 } 463 } 464 465 irq_list_done: 466 i40e_flush(hw); 467 } 468 469 /** 470 * i40e_release_rdma_qvlist 471 * @vf: pointer to the VF. 472 * 473 **/ 474 static void i40e_release_rdma_qvlist(struct i40e_vf *vf) 475 { 476 struct i40e_pf *pf = vf->pf; 477 struct virtchnl_rdma_qvlist_info *qvlist_info = vf->qvlist_info; 478 u32 msix_vf; 479 u32 i; 480 481 if (!vf->qvlist_info) 482 return; 483 484 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 485 for (i = 0; i < qvlist_info->num_vectors; i++) { 486 struct virtchnl_rdma_qv_info *qv_info; 487 u32 next_q_index, next_q_type; 488 struct i40e_hw *hw = &pf->hw; 489 u32 v_idx, reg_idx, reg; 490 491 qv_info = &qvlist_info->qv_info[i]; 492 if (!qv_info) 493 continue; 494 v_idx = qv_info->v_idx; 495 if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) { 496 /* Figure out the queue after CEQ and make that the 497 * first queue. 498 */ 499 reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx; 500 reg = rd32(hw, I40E_VPINT_CEQCTL(reg_idx)); 501 next_q_index = (reg & I40E_VPINT_CEQCTL_NEXTQ_INDX_MASK) 502 >> I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT; 503 next_q_type = (reg & I40E_VPINT_CEQCTL_NEXTQ_TYPE_MASK) 504 >> I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT; 505 506 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 507 reg = (next_q_index & 508 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) | 509 (next_q_type << 510 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 511 512 wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg); 513 } 514 } 515 kfree(vf->qvlist_info); 516 vf->qvlist_info = NULL; 517 } 518 519 /** 520 * i40e_config_rdma_qvlist 521 * @vf: pointer to the VF info 522 * @qvlist_info: queue and vector list 523 * 524 * Return 0 on success or < 0 on error 525 **/ 526 static int 527 i40e_config_rdma_qvlist(struct i40e_vf *vf, 528 struct virtchnl_rdma_qvlist_info *qvlist_info) 529 { 530 struct i40e_pf *pf = vf->pf; 531 struct i40e_hw *hw = &pf->hw; 532 struct virtchnl_rdma_qv_info *qv_info; 533 u32 v_idx, i, reg_idx, reg; 534 u32 next_q_idx, next_q_type; 535 size_t size; 536 u32 msix_vf; 537 int ret = 0; 538 539 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 540 541 if (qvlist_info->num_vectors > msix_vf) { 542 dev_warn(&pf->pdev->dev, 543 "Incorrect number of iwarp vectors %u. Maximum %u allowed.\n", 544 qvlist_info->num_vectors, 545 msix_vf); 546 ret = -EINVAL; 547 goto err_out; 548 } 549 550 kfree(vf->qvlist_info); 551 size = virtchnl_struct_size(vf->qvlist_info, qv_info, 552 qvlist_info->num_vectors); 553 vf->qvlist_info = kzalloc(size, GFP_KERNEL); 554 if (!vf->qvlist_info) { 555 ret = -ENOMEM; 556 goto err_out; 557 } 558 vf->qvlist_info->num_vectors = qvlist_info->num_vectors; 559 560 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 561 for (i = 0; i < qvlist_info->num_vectors; i++) { 562 qv_info = &qvlist_info->qv_info[i]; 563 if (!qv_info) 564 continue; 565 566 /* Validate vector id belongs to this vf */ 567 if (!i40e_vc_isvalid_vector_id(vf, qv_info->v_idx)) { 568 ret = -EINVAL; 569 goto err_free; 570 } 571 572 v_idx = qv_info->v_idx; 573 574 vf->qvlist_info->qv_info[i] = *qv_info; 575 576 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 577 /* We might be sharing the interrupt, so get the first queue 578 * index and type, push it down the list by adding the new 579 * queue on top. Also link it with the new queue in CEQCTL. 580 */ 581 reg = rd32(hw, I40E_VPINT_LNKLSTN(reg_idx)); 582 next_q_idx = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) >> 583 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_SHIFT); 584 next_q_type = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK) >> 585 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 586 587 if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) { 588 reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx; 589 reg = (I40E_VPINT_CEQCTL_CAUSE_ENA_MASK | 590 (v_idx << I40E_VPINT_CEQCTL_MSIX_INDX_SHIFT) | 591 (qv_info->itr_idx << I40E_VPINT_CEQCTL_ITR_INDX_SHIFT) | 592 (next_q_type << I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT) | 593 (next_q_idx << I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT)); 594 wr32(hw, I40E_VPINT_CEQCTL(reg_idx), reg); 595 596 reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1); 597 reg = (qv_info->ceq_idx & 598 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) | 599 (I40E_QUEUE_TYPE_PE_CEQ << 600 I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT); 601 wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg); 602 } 603 604 if (qv_info->aeq_idx != I40E_QUEUE_INVALID_IDX) { 605 reg = (I40E_VPINT_AEQCTL_CAUSE_ENA_MASK | 606 (v_idx << I40E_VPINT_AEQCTL_MSIX_INDX_SHIFT) | 607 (qv_info->itr_idx << I40E_VPINT_AEQCTL_ITR_INDX_SHIFT)); 608 609 wr32(hw, I40E_VPINT_AEQCTL(vf->vf_id), reg); 610 } 611 } 612 613 return 0; 614 err_free: 615 kfree(vf->qvlist_info); 616 vf->qvlist_info = NULL; 617 err_out: 618 return ret; 619 } 620 621 /** 622 * i40e_config_vsi_tx_queue 623 * @vf: pointer to the VF info 624 * @vsi_id: id of VSI as provided by the FW 625 * @vsi_queue_id: vsi relative queue index 626 * @info: config. info 627 * 628 * configure tx queue 629 **/ 630 static int i40e_config_vsi_tx_queue(struct i40e_vf *vf, u16 vsi_id, 631 u16 vsi_queue_id, 632 struct virtchnl_txq_info *info) 633 { 634 struct i40e_pf *pf = vf->pf; 635 struct i40e_hw *hw = &pf->hw; 636 struct i40e_hmc_obj_txq tx_ctx; 637 struct i40e_vsi *vsi; 638 u16 pf_queue_id; 639 u32 qtx_ctl; 640 int ret = 0; 641 642 if (!i40e_vc_isvalid_vsi_id(vf, info->vsi_id)) { 643 ret = -ENOENT; 644 goto error_context; 645 } 646 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id); 647 vsi = i40e_find_vsi_from_id(pf, vsi_id); 648 if (!vsi) { 649 ret = -ENOENT; 650 goto error_context; 651 } 652 653 /* clear the context structure first */ 654 memset(&tx_ctx, 0, sizeof(struct i40e_hmc_obj_txq)); 655 656 /* only set the required fields */ 657 tx_ctx.base = info->dma_ring_addr / 128; 658 tx_ctx.qlen = info->ring_len; 659 tx_ctx.rdylist = le16_to_cpu(vsi->info.qs_handle[0]); 660 tx_ctx.rdylist_act = 0; 661 tx_ctx.head_wb_ena = info->headwb_enabled; 662 tx_ctx.head_wb_addr = info->dma_headwb_addr; 663 664 /* clear the context in the HMC */ 665 ret = i40e_clear_lan_tx_queue_context(hw, pf_queue_id); 666 if (ret) { 667 dev_err(&pf->pdev->dev, 668 "Failed to clear VF LAN Tx queue context %d, error: %d\n", 669 pf_queue_id, ret); 670 ret = -ENOENT; 671 goto error_context; 672 } 673 674 /* set the context in the HMC */ 675 ret = i40e_set_lan_tx_queue_context(hw, pf_queue_id, &tx_ctx); 676 if (ret) { 677 dev_err(&pf->pdev->dev, 678 "Failed to set VF LAN Tx queue context %d error: %d\n", 679 pf_queue_id, ret); 680 ret = -ENOENT; 681 goto error_context; 682 } 683 684 /* associate this queue with the PCI VF function */ 685 qtx_ctl = I40E_QTX_CTL_VF_QUEUE; 686 qtx_ctl |= ((hw->pf_id << I40E_QTX_CTL_PF_INDX_SHIFT) 687 & I40E_QTX_CTL_PF_INDX_MASK); 688 qtx_ctl |= (((vf->vf_id + hw->func_caps.vf_base_id) 689 << I40E_QTX_CTL_VFVM_INDX_SHIFT) 690 & I40E_QTX_CTL_VFVM_INDX_MASK); 691 wr32(hw, I40E_QTX_CTL(pf_queue_id), qtx_ctl); 692 i40e_flush(hw); 693 694 error_context: 695 return ret; 696 } 697 698 /** 699 * i40e_config_vsi_rx_queue 700 * @vf: pointer to the VF info 701 * @vsi_id: id of VSI as provided by the FW 702 * @vsi_queue_id: vsi relative queue index 703 * @info: config. info 704 * 705 * configure rx queue 706 **/ 707 static int i40e_config_vsi_rx_queue(struct i40e_vf *vf, u16 vsi_id, 708 u16 vsi_queue_id, 709 struct virtchnl_rxq_info *info) 710 { 711 u16 pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id); 712 struct i40e_pf *pf = vf->pf; 713 struct i40e_vsi *vsi = pf->vsi[vf->lan_vsi_idx]; 714 struct i40e_hw *hw = &pf->hw; 715 struct i40e_hmc_obj_rxq rx_ctx; 716 int ret = 0; 717 718 /* clear the context structure first */ 719 memset(&rx_ctx, 0, sizeof(struct i40e_hmc_obj_rxq)); 720 721 /* only set the required fields */ 722 rx_ctx.base = info->dma_ring_addr / 128; 723 rx_ctx.qlen = info->ring_len; 724 725 if (info->splithdr_enabled) { 726 rx_ctx.hsplit_0 = I40E_RX_SPLIT_L2 | 727 I40E_RX_SPLIT_IP | 728 I40E_RX_SPLIT_TCP_UDP | 729 I40E_RX_SPLIT_SCTP; 730 /* header length validation */ 731 if (info->hdr_size > ((2 * 1024) - 64)) { 732 ret = -EINVAL; 733 goto error_param; 734 } 735 rx_ctx.hbuff = info->hdr_size >> I40E_RXQ_CTX_HBUFF_SHIFT; 736 737 /* set split mode 10b */ 738 rx_ctx.dtype = I40E_RX_DTYPE_HEADER_SPLIT; 739 } 740 741 /* databuffer length validation */ 742 if (info->databuffer_size > ((16 * 1024) - 128)) { 743 ret = -EINVAL; 744 goto error_param; 745 } 746 rx_ctx.dbuff = info->databuffer_size >> I40E_RXQ_CTX_DBUFF_SHIFT; 747 748 /* max pkt. length validation */ 749 if (info->max_pkt_size >= (16 * 1024) || info->max_pkt_size < 64) { 750 ret = -EINVAL; 751 goto error_param; 752 } 753 rx_ctx.rxmax = info->max_pkt_size; 754 755 /* if port VLAN is configured increase the max packet size */ 756 if (vsi->info.pvid) 757 rx_ctx.rxmax += VLAN_HLEN; 758 759 /* enable 32bytes desc always */ 760 rx_ctx.dsize = 1; 761 762 /* default values */ 763 rx_ctx.lrxqthresh = 1; 764 rx_ctx.crcstrip = 1; 765 rx_ctx.prefena = 1; 766 rx_ctx.l2tsel = 1; 767 768 /* clear the context in the HMC */ 769 ret = i40e_clear_lan_rx_queue_context(hw, pf_queue_id); 770 if (ret) { 771 dev_err(&pf->pdev->dev, 772 "Failed to clear VF LAN Rx queue context %d, error: %d\n", 773 pf_queue_id, ret); 774 ret = -ENOENT; 775 goto error_param; 776 } 777 778 /* set the context in the HMC */ 779 ret = i40e_set_lan_rx_queue_context(hw, pf_queue_id, &rx_ctx); 780 if (ret) { 781 dev_err(&pf->pdev->dev, 782 "Failed to set VF LAN Rx queue context %d error: %d\n", 783 pf_queue_id, ret); 784 ret = -ENOENT; 785 goto error_param; 786 } 787 788 error_param: 789 return ret; 790 } 791 792 /** 793 * i40e_alloc_vsi_res 794 * @vf: pointer to the VF info 795 * @idx: VSI index, applies only for ADq mode, zero otherwise 796 * 797 * alloc VF vsi context & resources 798 **/ 799 static int i40e_alloc_vsi_res(struct i40e_vf *vf, u8 idx) 800 { 801 struct i40e_mac_filter *f = NULL; 802 struct i40e_pf *pf = vf->pf; 803 struct i40e_vsi *vsi; 804 u64 max_tx_rate = 0; 805 int ret = 0; 806 807 vsi = i40e_vsi_setup(pf, I40E_VSI_SRIOV, pf->vsi[pf->lan_vsi]->seid, 808 vf->vf_id); 809 810 if (!vsi) { 811 dev_err(&pf->pdev->dev, 812 "add vsi failed for VF %d, aq_err %d\n", 813 vf->vf_id, pf->hw.aq.asq_last_status); 814 ret = -ENOENT; 815 goto error_alloc_vsi_res; 816 } 817 818 if (!idx) { 819 u64 hena = i40e_pf_get_default_rss_hena(pf); 820 u8 broadcast[ETH_ALEN]; 821 822 vf->lan_vsi_idx = vsi->idx; 823 vf->lan_vsi_id = vsi->id; 824 /* If the port VLAN has been configured and then the 825 * VF driver was removed then the VSI port VLAN 826 * configuration was destroyed. Check if there is 827 * a port VLAN and restore the VSI configuration if 828 * needed. 829 */ 830 if (vf->port_vlan_id) 831 i40e_vsi_add_pvid(vsi, vf->port_vlan_id); 832 833 spin_lock_bh(&vsi->mac_filter_hash_lock); 834 if (is_valid_ether_addr(vf->default_lan_addr.addr)) { 835 f = i40e_add_mac_filter(vsi, 836 vf->default_lan_addr.addr); 837 if (!f) 838 dev_info(&pf->pdev->dev, 839 "Could not add MAC filter %pM for VF %d\n", 840 vf->default_lan_addr.addr, vf->vf_id); 841 } 842 eth_broadcast_addr(broadcast); 843 f = i40e_add_mac_filter(vsi, broadcast); 844 if (!f) 845 dev_info(&pf->pdev->dev, 846 "Could not allocate VF broadcast filter\n"); 847 spin_unlock_bh(&vsi->mac_filter_hash_lock); 848 wr32(&pf->hw, I40E_VFQF_HENA1(0, vf->vf_id), (u32)hena); 849 wr32(&pf->hw, I40E_VFQF_HENA1(1, vf->vf_id), (u32)(hena >> 32)); 850 /* program mac filter only for VF VSI */ 851 ret = i40e_sync_vsi_filters(vsi); 852 if (ret) 853 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n"); 854 } 855 856 /* storing VSI index and id for ADq and don't apply the mac filter */ 857 if (vf->adq_enabled) { 858 vf->ch[idx].vsi_idx = vsi->idx; 859 vf->ch[idx].vsi_id = vsi->id; 860 } 861 862 /* Set VF bandwidth if specified */ 863 if (vf->tx_rate) { 864 max_tx_rate = vf->tx_rate; 865 } else if (vf->ch[idx].max_tx_rate) { 866 max_tx_rate = vf->ch[idx].max_tx_rate; 867 } 868 869 if (max_tx_rate) { 870 max_tx_rate = div_u64(max_tx_rate, I40E_BW_CREDIT_DIVISOR); 871 ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid, 872 max_tx_rate, 0, NULL); 873 if (ret) 874 dev_err(&pf->pdev->dev, "Unable to set tx rate, VF %d, error code %d.\n", 875 vf->vf_id, ret); 876 } 877 878 error_alloc_vsi_res: 879 return ret; 880 } 881 882 /** 883 * i40e_map_pf_queues_to_vsi 884 * @vf: pointer to the VF info 885 * 886 * PF maps LQPs to a VF by programming VSILAN_QTABLE & VPLAN_QTABLE. This 887 * function takes care of first part VSILAN_QTABLE, mapping pf queues to VSI. 888 **/ 889 static void i40e_map_pf_queues_to_vsi(struct i40e_vf *vf) 890 { 891 struct i40e_pf *pf = vf->pf; 892 struct i40e_hw *hw = &pf->hw; 893 u32 reg, num_tc = 1; /* VF has at least one traffic class */ 894 u16 vsi_id, qps; 895 int i, j; 896 897 if (vf->adq_enabled) 898 num_tc = vf->num_tc; 899 900 for (i = 0; i < num_tc; i++) { 901 if (vf->adq_enabled) { 902 qps = vf->ch[i].num_qps; 903 vsi_id = vf->ch[i].vsi_id; 904 } else { 905 qps = pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs; 906 vsi_id = vf->lan_vsi_id; 907 } 908 909 for (j = 0; j < 7; j++) { 910 if (j * 2 >= qps) { 911 /* end of list */ 912 reg = 0x07FF07FF; 913 } else { 914 u16 qid = i40e_vc_get_pf_queue_id(vf, 915 vsi_id, 916 j * 2); 917 reg = qid; 918 qid = i40e_vc_get_pf_queue_id(vf, vsi_id, 919 (j * 2) + 1); 920 reg |= qid << 16; 921 } 922 i40e_write_rx_ctl(hw, 923 I40E_VSILAN_QTABLE(j, vsi_id), 924 reg); 925 } 926 } 927 } 928 929 /** 930 * i40e_map_pf_to_vf_queues 931 * @vf: pointer to the VF info 932 * 933 * PF maps LQPs to a VF by programming VSILAN_QTABLE & VPLAN_QTABLE. This 934 * function takes care of the second part VPLAN_QTABLE & completes VF mappings. 935 **/ 936 static void i40e_map_pf_to_vf_queues(struct i40e_vf *vf) 937 { 938 struct i40e_pf *pf = vf->pf; 939 struct i40e_hw *hw = &pf->hw; 940 u32 reg, total_qps = 0; 941 u32 qps, num_tc = 1; /* VF has at least one traffic class */ 942 u16 vsi_id, qid; 943 int i, j; 944 945 if (vf->adq_enabled) 946 num_tc = vf->num_tc; 947 948 for (i = 0; i < num_tc; i++) { 949 if (vf->adq_enabled) { 950 qps = vf->ch[i].num_qps; 951 vsi_id = vf->ch[i].vsi_id; 952 } else { 953 qps = pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs; 954 vsi_id = vf->lan_vsi_id; 955 } 956 957 for (j = 0; j < qps; j++) { 958 qid = i40e_vc_get_pf_queue_id(vf, vsi_id, j); 959 960 reg = (qid & I40E_VPLAN_QTABLE_QINDEX_MASK); 961 wr32(hw, I40E_VPLAN_QTABLE(total_qps, vf->vf_id), 962 reg); 963 total_qps++; 964 } 965 } 966 } 967 968 /** 969 * i40e_enable_vf_mappings 970 * @vf: pointer to the VF info 971 * 972 * enable VF mappings 973 **/ 974 static void i40e_enable_vf_mappings(struct i40e_vf *vf) 975 { 976 struct i40e_pf *pf = vf->pf; 977 struct i40e_hw *hw = &pf->hw; 978 u32 reg; 979 980 /* Tell the hardware we're using noncontiguous mapping. HW requires 981 * that VF queues be mapped using this method, even when they are 982 * contiguous in real life 983 */ 984 i40e_write_rx_ctl(hw, I40E_VSILAN_QBASE(vf->lan_vsi_id), 985 I40E_VSILAN_QBASE_VSIQTABLE_ENA_MASK); 986 987 /* enable VF vplan_qtable mappings */ 988 reg = I40E_VPLAN_MAPENA_TXRX_ENA_MASK; 989 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), reg); 990 991 i40e_map_pf_to_vf_queues(vf); 992 i40e_map_pf_queues_to_vsi(vf); 993 994 i40e_flush(hw); 995 } 996 997 /** 998 * i40e_disable_vf_mappings 999 * @vf: pointer to the VF info 1000 * 1001 * disable VF mappings 1002 **/ 1003 static void i40e_disable_vf_mappings(struct i40e_vf *vf) 1004 { 1005 struct i40e_pf *pf = vf->pf; 1006 struct i40e_hw *hw = &pf->hw; 1007 int i; 1008 1009 /* disable qp mappings */ 1010 wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), 0); 1011 for (i = 0; i < I40E_MAX_VSI_QP; i++) 1012 wr32(hw, I40E_VPLAN_QTABLE(i, vf->vf_id), 1013 I40E_QUEUE_END_OF_LIST); 1014 i40e_flush(hw); 1015 } 1016 1017 /** 1018 * i40e_free_vf_res 1019 * @vf: pointer to the VF info 1020 * 1021 * free VF resources 1022 **/ 1023 static void i40e_free_vf_res(struct i40e_vf *vf) 1024 { 1025 struct i40e_pf *pf = vf->pf; 1026 struct i40e_hw *hw = &pf->hw; 1027 u32 reg_idx, reg; 1028 int i, j, msix_vf; 1029 1030 /* Start by disabling VF's configuration API to prevent the OS from 1031 * accessing the VF's VSI after it's freed / invalidated. 1032 */ 1033 clear_bit(I40E_VF_STATE_INIT, &vf->vf_states); 1034 1035 /* It's possible the VF had requeuested more queues than the default so 1036 * do the accounting here when we're about to free them. 1037 */ 1038 if (vf->num_queue_pairs > I40E_DEFAULT_QUEUES_PER_VF) { 1039 pf->queues_left += vf->num_queue_pairs - 1040 I40E_DEFAULT_QUEUES_PER_VF; 1041 } 1042 1043 /* free vsi & disconnect it from the parent uplink */ 1044 if (vf->lan_vsi_idx) { 1045 i40e_vsi_release(pf->vsi[vf->lan_vsi_idx]); 1046 vf->lan_vsi_idx = 0; 1047 vf->lan_vsi_id = 0; 1048 } 1049 1050 /* do the accounting and remove additional ADq VSI's */ 1051 if (vf->adq_enabled && vf->ch[0].vsi_idx) { 1052 for (j = 0; j < vf->num_tc; j++) { 1053 /* At this point VSI0 is already released so don't 1054 * release it again and only clear their values in 1055 * structure variables 1056 */ 1057 if (j) 1058 i40e_vsi_release(pf->vsi[vf->ch[j].vsi_idx]); 1059 vf->ch[j].vsi_idx = 0; 1060 vf->ch[j].vsi_id = 0; 1061 } 1062 } 1063 msix_vf = pf->hw.func_caps.num_msix_vectors_vf; 1064 1065 /* disable interrupts so the VF starts in a known state */ 1066 for (i = 0; i < msix_vf; i++) { 1067 /* format is same for both registers */ 1068 if (0 == i) 1069 reg_idx = I40E_VFINT_DYN_CTL0(vf->vf_id); 1070 else 1071 reg_idx = I40E_VFINT_DYN_CTLN(((msix_vf - 1) * 1072 (vf->vf_id)) 1073 + (i - 1)); 1074 wr32(hw, reg_idx, I40E_VFINT_DYN_CTLN_CLEARPBA_MASK); 1075 i40e_flush(hw); 1076 } 1077 1078 /* clear the irq settings */ 1079 for (i = 0; i < msix_vf; i++) { 1080 /* format is same for both registers */ 1081 if (0 == i) 1082 reg_idx = I40E_VPINT_LNKLST0(vf->vf_id); 1083 else 1084 reg_idx = I40E_VPINT_LNKLSTN(((msix_vf - 1) * 1085 (vf->vf_id)) 1086 + (i - 1)); 1087 reg = (I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK | 1088 I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK); 1089 wr32(hw, reg_idx, reg); 1090 i40e_flush(hw); 1091 } 1092 /* reset some of the state variables keeping track of the resources */ 1093 vf->num_queue_pairs = 0; 1094 clear_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states); 1095 clear_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states); 1096 } 1097 1098 /** 1099 * i40e_alloc_vf_res 1100 * @vf: pointer to the VF info 1101 * 1102 * allocate VF resources 1103 **/ 1104 static int i40e_alloc_vf_res(struct i40e_vf *vf) 1105 { 1106 struct i40e_pf *pf = vf->pf; 1107 int total_queue_pairs = 0; 1108 int ret, idx; 1109 1110 if (vf->num_req_queues && 1111 vf->num_req_queues <= pf->queues_left + I40E_DEFAULT_QUEUES_PER_VF) 1112 pf->num_vf_qps = vf->num_req_queues; 1113 else 1114 pf->num_vf_qps = I40E_DEFAULT_QUEUES_PER_VF; 1115 1116 /* allocate hw vsi context & associated resources */ 1117 ret = i40e_alloc_vsi_res(vf, 0); 1118 if (ret) 1119 goto error_alloc; 1120 total_queue_pairs += pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs; 1121 1122 /* allocate additional VSIs based on tc information for ADq */ 1123 if (vf->adq_enabled) { 1124 if (pf->queues_left >= 1125 (I40E_MAX_VF_QUEUES - I40E_DEFAULT_QUEUES_PER_VF)) { 1126 /* TC 0 always belongs to VF VSI */ 1127 for (idx = 1; idx < vf->num_tc; idx++) { 1128 ret = i40e_alloc_vsi_res(vf, idx); 1129 if (ret) 1130 goto error_alloc; 1131 } 1132 /* send correct number of queues */ 1133 total_queue_pairs = I40E_MAX_VF_QUEUES; 1134 } else { 1135 dev_info(&pf->pdev->dev, "VF %d: Not enough queues to allocate, disabling ADq\n", 1136 vf->vf_id); 1137 vf->adq_enabled = false; 1138 } 1139 } 1140 1141 /* We account for each VF to get a default number of queue pairs. If 1142 * the VF has now requested more, we need to account for that to make 1143 * certain we never request more queues than we actually have left in 1144 * HW. 1145 */ 1146 if (total_queue_pairs > I40E_DEFAULT_QUEUES_PER_VF) 1147 pf->queues_left -= 1148 total_queue_pairs - I40E_DEFAULT_QUEUES_PER_VF; 1149 1150 if (vf->trusted) 1151 set_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps); 1152 else 1153 clear_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps); 1154 1155 /* store the total qps number for the runtime 1156 * VF req validation 1157 */ 1158 vf->num_queue_pairs = total_queue_pairs; 1159 1160 /* VF is now completely initialized */ 1161 set_bit(I40E_VF_STATE_INIT, &vf->vf_states); 1162 1163 error_alloc: 1164 if (ret) 1165 i40e_free_vf_res(vf); 1166 1167 return ret; 1168 } 1169 1170 #define VF_DEVICE_STATUS 0xAA 1171 #define VF_TRANS_PENDING_MASK 0x20 1172 /** 1173 * i40e_quiesce_vf_pci 1174 * @vf: pointer to the VF structure 1175 * 1176 * Wait for VF PCI transactions to be cleared after reset. Returns -EIO 1177 * if the transactions never clear. 1178 **/ 1179 static int i40e_quiesce_vf_pci(struct i40e_vf *vf) 1180 { 1181 struct i40e_pf *pf = vf->pf; 1182 struct i40e_hw *hw = &pf->hw; 1183 int vf_abs_id, i; 1184 u32 reg; 1185 1186 vf_abs_id = vf->vf_id + hw->func_caps.vf_base_id; 1187 1188 wr32(hw, I40E_PF_PCI_CIAA, 1189 VF_DEVICE_STATUS | (vf_abs_id << I40E_PF_PCI_CIAA_VF_NUM_SHIFT)); 1190 for (i = 0; i < 100; i++) { 1191 reg = rd32(hw, I40E_PF_PCI_CIAD); 1192 if ((reg & VF_TRANS_PENDING_MASK) == 0) 1193 return 0; 1194 udelay(1); 1195 } 1196 return -EIO; 1197 } 1198 1199 /** 1200 * __i40e_getnum_vf_vsi_vlan_filters 1201 * @vsi: pointer to the vsi 1202 * 1203 * called to get the number of VLANs offloaded on this VF 1204 **/ 1205 static int __i40e_getnum_vf_vsi_vlan_filters(struct i40e_vsi *vsi) 1206 { 1207 struct i40e_mac_filter *f; 1208 u16 num_vlans = 0, bkt; 1209 1210 hash_for_each(vsi->mac_filter_hash, bkt, f, hlist) { 1211 if (f->vlan >= 0 && f->vlan <= I40E_MAX_VLANID) 1212 num_vlans++; 1213 } 1214 1215 return num_vlans; 1216 } 1217 1218 /** 1219 * i40e_getnum_vf_vsi_vlan_filters 1220 * @vsi: pointer to the vsi 1221 * 1222 * wrapper for __i40e_getnum_vf_vsi_vlan_filters() with spinlock held 1223 **/ 1224 static int i40e_getnum_vf_vsi_vlan_filters(struct i40e_vsi *vsi) 1225 { 1226 int num_vlans; 1227 1228 spin_lock_bh(&vsi->mac_filter_hash_lock); 1229 num_vlans = __i40e_getnum_vf_vsi_vlan_filters(vsi); 1230 spin_unlock_bh(&vsi->mac_filter_hash_lock); 1231 1232 return num_vlans; 1233 } 1234 1235 /** 1236 * i40e_get_vlan_list_sync 1237 * @vsi: pointer to the VSI 1238 * @num_vlans: number of VLANs in mac_filter_hash, returned to caller 1239 * @vlan_list: list of VLANs present in mac_filter_hash, returned to caller. 1240 * This array is allocated here, but has to be freed in caller. 1241 * 1242 * Called to get number of VLANs and VLAN list present in mac_filter_hash. 1243 **/ 1244 static void i40e_get_vlan_list_sync(struct i40e_vsi *vsi, u16 *num_vlans, 1245 s16 **vlan_list) 1246 { 1247 struct i40e_mac_filter *f; 1248 int i = 0; 1249 int bkt; 1250 1251 spin_lock_bh(&vsi->mac_filter_hash_lock); 1252 *num_vlans = __i40e_getnum_vf_vsi_vlan_filters(vsi); 1253 *vlan_list = kcalloc(*num_vlans, sizeof(**vlan_list), GFP_ATOMIC); 1254 if (!(*vlan_list)) 1255 goto err; 1256 1257 hash_for_each(vsi->mac_filter_hash, bkt, f, hlist) { 1258 if (f->vlan < 0 || f->vlan > I40E_MAX_VLANID) 1259 continue; 1260 (*vlan_list)[i++] = f->vlan; 1261 } 1262 err: 1263 spin_unlock_bh(&vsi->mac_filter_hash_lock); 1264 } 1265 1266 /** 1267 * i40e_set_vsi_promisc 1268 * @vf: pointer to the VF struct 1269 * @seid: VSI number 1270 * @multi_enable: set MAC L2 layer multicast promiscuous enable/disable 1271 * for a given VLAN 1272 * @unicast_enable: set MAC L2 layer unicast promiscuous enable/disable 1273 * for a given VLAN 1274 * @vl: List of VLANs - apply filter for given VLANs 1275 * @num_vlans: Number of elements in @vl 1276 **/ 1277 static int 1278 i40e_set_vsi_promisc(struct i40e_vf *vf, u16 seid, bool multi_enable, 1279 bool unicast_enable, s16 *vl, u16 num_vlans) 1280 { 1281 struct i40e_pf *pf = vf->pf; 1282 struct i40e_hw *hw = &pf->hw; 1283 int aq_ret, aq_tmp = 0; 1284 int i; 1285 1286 /* No VLAN to set promisc on, set on VSI */ 1287 if (!num_vlans || !vl) { 1288 aq_ret = i40e_aq_set_vsi_multicast_promiscuous(hw, seid, 1289 multi_enable, 1290 NULL); 1291 if (aq_ret) { 1292 int aq_err = pf->hw.aq.asq_last_status; 1293 1294 dev_err(&pf->pdev->dev, 1295 "VF %d failed to set multicast promiscuous mode err %pe aq_err %s\n", 1296 vf->vf_id, 1297 ERR_PTR(aq_ret), 1298 i40e_aq_str(&pf->hw, aq_err)); 1299 1300 return aq_ret; 1301 } 1302 1303 aq_ret = i40e_aq_set_vsi_unicast_promiscuous(hw, seid, 1304 unicast_enable, 1305 NULL, true); 1306 1307 if (aq_ret) { 1308 int aq_err = pf->hw.aq.asq_last_status; 1309 1310 dev_err(&pf->pdev->dev, 1311 "VF %d failed to set unicast promiscuous mode err %pe aq_err %s\n", 1312 vf->vf_id, 1313 ERR_PTR(aq_ret), 1314 i40e_aq_str(&pf->hw, aq_err)); 1315 } 1316 1317 return aq_ret; 1318 } 1319 1320 for (i = 0; i < num_vlans; i++) { 1321 aq_ret = i40e_aq_set_vsi_mc_promisc_on_vlan(hw, seid, 1322 multi_enable, 1323 vl[i], NULL); 1324 if (aq_ret) { 1325 int aq_err = pf->hw.aq.asq_last_status; 1326 1327 dev_err(&pf->pdev->dev, 1328 "VF %d failed to set multicast promiscuous mode err %pe aq_err %s\n", 1329 vf->vf_id, 1330 ERR_PTR(aq_ret), 1331 i40e_aq_str(&pf->hw, aq_err)); 1332 1333 if (!aq_tmp) 1334 aq_tmp = aq_ret; 1335 } 1336 1337 aq_ret = i40e_aq_set_vsi_uc_promisc_on_vlan(hw, seid, 1338 unicast_enable, 1339 vl[i], NULL); 1340 if (aq_ret) { 1341 int aq_err = pf->hw.aq.asq_last_status; 1342 1343 dev_err(&pf->pdev->dev, 1344 "VF %d failed to set unicast promiscuous mode err %pe aq_err %s\n", 1345 vf->vf_id, 1346 ERR_PTR(aq_ret), 1347 i40e_aq_str(&pf->hw, aq_err)); 1348 1349 if (!aq_tmp) 1350 aq_tmp = aq_ret; 1351 } 1352 } 1353 1354 if (aq_tmp) 1355 aq_ret = aq_tmp; 1356 1357 return aq_ret; 1358 } 1359 1360 /** 1361 * i40e_config_vf_promiscuous_mode 1362 * @vf: pointer to the VF info 1363 * @vsi_id: VSI id 1364 * @allmulti: set MAC L2 layer multicast promiscuous enable/disable 1365 * @alluni: set MAC L2 layer unicast promiscuous enable/disable 1366 * 1367 * Called from the VF to configure the promiscuous mode of 1368 * VF vsis and from the VF reset path to reset promiscuous mode. 1369 **/ 1370 static int i40e_config_vf_promiscuous_mode(struct i40e_vf *vf, 1371 u16 vsi_id, 1372 bool allmulti, 1373 bool alluni) 1374 { 1375 struct i40e_pf *pf = vf->pf; 1376 struct i40e_vsi *vsi; 1377 int aq_ret = 0; 1378 u16 num_vlans; 1379 s16 *vl; 1380 1381 vsi = i40e_find_vsi_from_id(pf, vsi_id); 1382 if (!i40e_vc_isvalid_vsi_id(vf, vsi_id) || !vsi) 1383 return -EINVAL; 1384 1385 if (vf->port_vlan_id) { 1386 aq_ret = i40e_set_vsi_promisc(vf, vsi->seid, allmulti, 1387 alluni, &vf->port_vlan_id, 1); 1388 return aq_ret; 1389 } else if (i40e_getnum_vf_vsi_vlan_filters(vsi)) { 1390 i40e_get_vlan_list_sync(vsi, &num_vlans, &vl); 1391 1392 if (!vl) 1393 return -ENOMEM; 1394 1395 aq_ret = i40e_set_vsi_promisc(vf, vsi->seid, allmulti, alluni, 1396 vl, num_vlans); 1397 kfree(vl); 1398 return aq_ret; 1399 } 1400 1401 /* no VLANs to set on, set on VSI */ 1402 aq_ret = i40e_set_vsi_promisc(vf, vsi->seid, allmulti, alluni, 1403 NULL, 0); 1404 return aq_ret; 1405 } 1406 1407 /** 1408 * i40e_sync_vfr_reset 1409 * @hw: pointer to hw struct 1410 * @vf_id: VF identifier 1411 * 1412 * Before trigger hardware reset, we need to know if no other process has 1413 * reserved the hardware for any reset operations. This check is done by 1414 * examining the status of the RSTAT1 register used to signal the reset. 1415 **/ 1416 static int i40e_sync_vfr_reset(struct i40e_hw *hw, int vf_id) 1417 { 1418 u32 reg; 1419 int i; 1420 1421 for (i = 0; i < I40E_VFR_WAIT_COUNT; i++) { 1422 reg = rd32(hw, I40E_VFINT_ICR0_ENA(vf_id)) & 1423 I40E_VFINT_ICR0_ADMINQ_MASK; 1424 if (reg) 1425 return 0; 1426 1427 usleep_range(100, 200); 1428 } 1429 1430 return -EAGAIN; 1431 } 1432 1433 /** 1434 * i40e_trigger_vf_reset 1435 * @vf: pointer to the VF structure 1436 * @flr: VFLR was issued or not 1437 * 1438 * Trigger hardware to start a reset for a particular VF. Expects the caller 1439 * to wait the proper amount of time to allow hardware to reset the VF before 1440 * it cleans up and restores VF functionality. 1441 **/ 1442 static void i40e_trigger_vf_reset(struct i40e_vf *vf, bool flr) 1443 { 1444 struct i40e_pf *pf = vf->pf; 1445 struct i40e_hw *hw = &pf->hw; 1446 u32 reg, reg_idx, bit_idx; 1447 bool vf_active; 1448 u32 radq; 1449 1450 /* warn the VF */ 1451 vf_active = test_and_clear_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states); 1452 1453 /* Disable VF's configuration API during reset. The flag is re-enabled 1454 * in i40e_alloc_vf_res(), when it's safe again to access VF's VSI. 1455 * It's normally disabled in i40e_free_vf_res(), but it's safer 1456 * to do it earlier to give some time to finish to any VF config 1457 * functions that may still be running at this point. 1458 */ 1459 clear_bit(I40E_VF_STATE_INIT, &vf->vf_states); 1460 1461 /* In the case of a VFLR, the HW has already reset the VF and we 1462 * just need to clean up, so don't hit the VFRTRIG register. 1463 */ 1464 if (!flr) { 1465 /* Sync VFR reset before trigger next one */ 1466 radq = rd32(hw, I40E_VFINT_ICR0_ENA(vf->vf_id)) & 1467 I40E_VFINT_ICR0_ADMINQ_MASK; 1468 if (vf_active && !radq) 1469 /* waiting for finish reset by virtual driver */ 1470 if (i40e_sync_vfr_reset(hw, vf->vf_id)) 1471 dev_info(&pf->pdev->dev, 1472 "Reset VF %d never finished\n", 1473 vf->vf_id); 1474 1475 /* Reset VF using VPGEN_VFRTRIG reg. It is also setting 1476 * in progress state in rstat1 register. 1477 */ 1478 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id)); 1479 reg |= I40E_VPGEN_VFRTRIG_VFSWR_MASK; 1480 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg); 1481 i40e_flush(hw); 1482 } 1483 /* clear the VFLR bit in GLGEN_VFLRSTAT */ 1484 reg_idx = (hw->func_caps.vf_base_id + vf->vf_id) / 32; 1485 bit_idx = (hw->func_caps.vf_base_id + vf->vf_id) % 32; 1486 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx)); 1487 i40e_flush(hw); 1488 1489 if (i40e_quiesce_vf_pci(vf)) 1490 dev_err(&pf->pdev->dev, "VF %d PCI transactions stuck\n", 1491 vf->vf_id); 1492 } 1493 1494 /** 1495 * i40e_cleanup_reset_vf 1496 * @vf: pointer to the VF structure 1497 * 1498 * Cleanup a VF after the hardware reset is finished. Expects the caller to 1499 * have verified whether the reset is finished properly, and ensure the 1500 * minimum amount of wait time has passed. 1501 **/ 1502 static void i40e_cleanup_reset_vf(struct i40e_vf *vf) 1503 { 1504 struct i40e_pf *pf = vf->pf; 1505 struct i40e_hw *hw = &pf->hw; 1506 u32 reg; 1507 1508 /* disable promisc modes in case they were enabled */ 1509 i40e_config_vf_promiscuous_mode(vf, vf->lan_vsi_id, false, false); 1510 1511 /* free VF resources to begin resetting the VSI state */ 1512 i40e_free_vf_res(vf); 1513 1514 /* Enable hardware by clearing the reset bit in the VPGEN_VFRTRIG reg. 1515 * By doing this we allow HW to access VF memory at any point. If we 1516 * did it any sooner, HW could access memory while it was being freed 1517 * in i40e_free_vf_res(), causing an IOMMU fault. 1518 * 1519 * On the other hand, this needs to be done ASAP, because the VF driver 1520 * is waiting for this to happen and may report a timeout. It's 1521 * harmless, but it gets logged into Guest OS kernel log, so best avoid 1522 * it. 1523 */ 1524 reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id)); 1525 reg &= ~I40E_VPGEN_VFRTRIG_VFSWR_MASK; 1526 wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg); 1527 1528 /* reallocate VF resources to finish resetting the VSI state */ 1529 if (!i40e_alloc_vf_res(vf)) { 1530 int abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 1531 i40e_enable_vf_mappings(vf); 1532 set_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states); 1533 clear_bit(I40E_VF_STATE_DISABLED, &vf->vf_states); 1534 /* Do not notify the client during VF init */ 1535 if (!test_and_clear_bit(I40E_VF_STATE_PRE_ENABLE, 1536 &vf->vf_states)) 1537 i40e_notify_client_of_vf_reset(pf, abs_vf_id); 1538 vf->num_vlan = 0; 1539 } 1540 1541 /* Tell the VF driver the reset is done. This needs to be done only 1542 * after VF has been fully initialized, because the VF driver may 1543 * request resources immediately after setting this flag. 1544 */ 1545 wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), VIRTCHNL_VFR_VFACTIVE); 1546 } 1547 1548 /** 1549 * i40e_reset_vf 1550 * @vf: pointer to the VF structure 1551 * @flr: VFLR was issued or not 1552 * 1553 * Returns true if the VF is in reset, resets successfully, or resets 1554 * are disabled and false otherwise. 1555 **/ 1556 bool i40e_reset_vf(struct i40e_vf *vf, bool flr) 1557 { 1558 struct i40e_pf *pf = vf->pf; 1559 struct i40e_hw *hw = &pf->hw; 1560 bool rsd = false; 1561 u32 reg; 1562 int i; 1563 1564 if (test_bit(__I40E_VF_RESETS_DISABLED, pf->state)) 1565 return true; 1566 1567 /* Bail out if VFs are disabled. */ 1568 if (test_bit(__I40E_VF_DISABLE, pf->state)) 1569 return true; 1570 1571 /* If VF is being reset already we don't need to continue. */ 1572 if (test_and_set_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) 1573 return true; 1574 1575 i40e_trigger_vf_reset(vf, flr); 1576 1577 /* poll VPGEN_VFRSTAT reg to make sure 1578 * that reset is complete 1579 */ 1580 for (i = 0; i < 10; i++) { 1581 /* VF reset requires driver to first reset the VF and then 1582 * poll the status register to make sure that the reset 1583 * completed successfully. Due to internal HW FIFO flushes, 1584 * we must wait 10ms before the register will be valid. 1585 */ 1586 usleep_range(10000, 20000); 1587 reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id)); 1588 if (reg & I40E_VPGEN_VFRSTAT_VFRD_MASK) { 1589 rsd = true; 1590 break; 1591 } 1592 } 1593 1594 if (flr) 1595 usleep_range(10000, 20000); 1596 1597 if (!rsd) 1598 dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n", 1599 vf->vf_id); 1600 usleep_range(10000, 20000); 1601 1602 /* On initial reset, we don't have any queues to disable */ 1603 if (vf->lan_vsi_idx != 0) 1604 i40e_vsi_stop_rings(pf->vsi[vf->lan_vsi_idx]); 1605 1606 i40e_cleanup_reset_vf(vf); 1607 1608 i40e_flush(hw); 1609 usleep_range(20000, 40000); 1610 clear_bit(I40E_VF_STATE_RESETTING, &vf->vf_states); 1611 1612 return true; 1613 } 1614 1615 /** 1616 * i40e_reset_all_vfs 1617 * @pf: pointer to the PF structure 1618 * @flr: VFLR was issued or not 1619 * 1620 * Reset all allocated VFs in one go. First, tell the hardware to reset each 1621 * VF, then do all the waiting in one chunk, and finally finish restoring each 1622 * VF after the wait. This is useful during PF routines which need to reset 1623 * all VFs, as otherwise it must perform these resets in a serialized fashion. 1624 * 1625 * Returns true if any VFs were reset, and false otherwise. 1626 **/ 1627 bool i40e_reset_all_vfs(struct i40e_pf *pf, bool flr) 1628 { 1629 struct i40e_hw *hw = &pf->hw; 1630 struct i40e_vf *vf; 1631 int i, v; 1632 u32 reg; 1633 1634 /* If we don't have any VFs, then there is nothing to reset */ 1635 if (!pf->num_alloc_vfs) 1636 return false; 1637 1638 /* If VFs have been disabled, there is no need to reset */ 1639 if (test_and_set_bit(__I40E_VF_DISABLE, pf->state)) 1640 return false; 1641 1642 /* Begin reset on all VFs at once */ 1643 for (v = 0; v < pf->num_alloc_vfs; v++) { 1644 vf = &pf->vf[v]; 1645 /* If VF is being reset no need to trigger reset again */ 1646 if (!test_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) 1647 i40e_trigger_vf_reset(&pf->vf[v], flr); 1648 } 1649 1650 /* HW requires some time to make sure it can flush the FIFO for a VF 1651 * when it resets it. Poll the VPGEN_VFRSTAT register for each VF in 1652 * sequence to make sure that it has completed. We'll keep track of 1653 * the VFs using a simple iterator that increments once that VF has 1654 * finished resetting. 1655 */ 1656 for (i = 0, v = 0; i < 10 && v < pf->num_alloc_vfs; i++) { 1657 usleep_range(10000, 20000); 1658 1659 /* Check each VF in sequence, beginning with the VF to fail 1660 * the previous check. 1661 */ 1662 while (v < pf->num_alloc_vfs) { 1663 vf = &pf->vf[v]; 1664 if (!test_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) { 1665 reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id)); 1666 if (!(reg & I40E_VPGEN_VFRSTAT_VFRD_MASK)) 1667 break; 1668 } 1669 1670 /* If the current VF has finished resetting, move on 1671 * to the next VF in sequence. 1672 */ 1673 v++; 1674 } 1675 } 1676 1677 if (flr) 1678 usleep_range(10000, 20000); 1679 1680 /* Display a warning if at least one VF didn't manage to reset in 1681 * time, but continue on with the operation. 1682 */ 1683 if (v < pf->num_alloc_vfs) 1684 dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n", 1685 pf->vf[v].vf_id); 1686 usleep_range(10000, 20000); 1687 1688 /* Begin disabling all the rings associated with VFs, but do not wait 1689 * between each VF. 1690 */ 1691 for (v = 0; v < pf->num_alloc_vfs; v++) { 1692 /* On initial reset, we don't have any queues to disable */ 1693 if (pf->vf[v].lan_vsi_idx == 0) 1694 continue; 1695 1696 /* If VF is reset in another thread just continue */ 1697 if (test_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) 1698 continue; 1699 1700 i40e_vsi_stop_rings_no_wait(pf->vsi[pf->vf[v].lan_vsi_idx]); 1701 } 1702 1703 /* Now that we've notified HW to disable all of the VF rings, wait 1704 * until they finish. 1705 */ 1706 for (v = 0; v < pf->num_alloc_vfs; v++) { 1707 /* On initial reset, we don't have any queues to disable */ 1708 if (pf->vf[v].lan_vsi_idx == 0) 1709 continue; 1710 1711 /* If VF is reset in another thread just continue */ 1712 if (test_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) 1713 continue; 1714 1715 i40e_vsi_wait_queues_disabled(pf->vsi[pf->vf[v].lan_vsi_idx]); 1716 } 1717 1718 /* Hw may need up to 50ms to finish disabling the RX queues. We 1719 * minimize the wait by delaying only once for all VFs. 1720 */ 1721 mdelay(50); 1722 1723 /* Finish the reset on each VF */ 1724 for (v = 0; v < pf->num_alloc_vfs; v++) { 1725 /* If VF is reset in another thread just continue */ 1726 if (test_bit(I40E_VF_STATE_RESETTING, &vf->vf_states)) 1727 continue; 1728 1729 i40e_cleanup_reset_vf(&pf->vf[v]); 1730 } 1731 1732 i40e_flush(hw); 1733 usleep_range(20000, 40000); 1734 clear_bit(__I40E_VF_DISABLE, pf->state); 1735 1736 return true; 1737 } 1738 1739 /** 1740 * i40e_free_vfs 1741 * @pf: pointer to the PF structure 1742 * 1743 * free VF resources 1744 **/ 1745 void i40e_free_vfs(struct i40e_pf *pf) 1746 { 1747 struct i40e_hw *hw = &pf->hw; 1748 u32 reg_idx, bit_idx; 1749 int i, tmp, vf_id; 1750 1751 if (!pf->vf) 1752 return; 1753 1754 set_bit(__I40E_VFS_RELEASING, pf->state); 1755 while (test_and_set_bit(__I40E_VF_DISABLE, pf->state)) 1756 usleep_range(1000, 2000); 1757 1758 i40e_notify_client_of_vf_enable(pf, 0); 1759 1760 /* Disable IOV before freeing resources. This lets any VF drivers 1761 * running in the host get themselves cleaned up before we yank 1762 * the carpet out from underneath their feet. 1763 */ 1764 if (!pci_vfs_assigned(pf->pdev)) 1765 pci_disable_sriov(pf->pdev); 1766 else 1767 dev_warn(&pf->pdev->dev, "VFs are assigned - not disabling SR-IOV\n"); 1768 1769 /* Amortize wait time by stopping all VFs at the same time */ 1770 for (i = 0; i < pf->num_alloc_vfs; i++) { 1771 if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states)) 1772 continue; 1773 1774 i40e_vsi_stop_rings_no_wait(pf->vsi[pf->vf[i].lan_vsi_idx]); 1775 } 1776 1777 for (i = 0; i < pf->num_alloc_vfs; i++) { 1778 if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states)) 1779 continue; 1780 1781 i40e_vsi_wait_queues_disabled(pf->vsi[pf->vf[i].lan_vsi_idx]); 1782 } 1783 1784 /* free up VF resources */ 1785 tmp = pf->num_alloc_vfs; 1786 pf->num_alloc_vfs = 0; 1787 for (i = 0; i < tmp; i++) { 1788 if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states)) 1789 i40e_free_vf_res(&pf->vf[i]); 1790 /* disable qp mappings */ 1791 i40e_disable_vf_mappings(&pf->vf[i]); 1792 } 1793 1794 kfree(pf->vf); 1795 pf->vf = NULL; 1796 1797 /* This check is for when the driver is unloaded while VFs are 1798 * assigned. Setting the number of VFs to 0 through sysfs is caught 1799 * before this function ever gets called. 1800 */ 1801 if (!pci_vfs_assigned(pf->pdev)) { 1802 /* Acknowledge VFLR for all VFS. Without this, VFs will fail to 1803 * work correctly when SR-IOV gets re-enabled. 1804 */ 1805 for (vf_id = 0; vf_id < tmp; vf_id++) { 1806 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32; 1807 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32; 1808 wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx)); 1809 } 1810 } 1811 clear_bit(__I40E_VF_DISABLE, pf->state); 1812 clear_bit(__I40E_VFS_RELEASING, pf->state); 1813 } 1814 1815 #ifdef CONFIG_PCI_IOV 1816 /** 1817 * i40e_alloc_vfs 1818 * @pf: pointer to the PF structure 1819 * @num_alloc_vfs: number of VFs to allocate 1820 * 1821 * allocate VF resources 1822 **/ 1823 int i40e_alloc_vfs(struct i40e_pf *pf, u16 num_alloc_vfs) 1824 { 1825 struct i40e_vf *vfs; 1826 int i, ret = 0; 1827 1828 /* Disable interrupt 0 so we don't try to handle the VFLR. */ 1829 i40e_irq_dynamic_disable_icr0(pf); 1830 1831 /* Check to see if we're just allocating resources for extant VFs */ 1832 if (pci_num_vf(pf->pdev) != num_alloc_vfs) { 1833 ret = pci_enable_sriov(pf->pdev, num_alloc_vfs); 1834 if (ret) { 1835 pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED; 1836 pf->num_alloc_vfs = 0; 1837 goto err_iov; 1838 } 1839 } 1840 /* allocate memory */ 1841 vfs = kcalloc(num_alloc_vfs, sizeof(struct i40e_vf), GFP_KERNEL); 1842 if (!vfs) { 1843 ret = -ENOMEM; 1844 goto err_alloc; 1845 } 1846 pf->vf = vfs; 1847 1848 /* apply default profile */ 1849 for (i = 0; i < num_alloc_vfs; i++) { 1850 vfs[i].pf = pf; 1851 vfs[i].parent_type = I40E_SWITCH_ELEMENT_TYPE_VEB; 1852 vfs[i].vf_id = i; 1853 1854 /* assign default capabilities */ 1855 set_bit(I40E_VIRTCHNL_VF_CAP_L2, &vfs[i].vf_caps); 1856 vfs[i].spoofchk = true; 1857 1858 set_bit(I40E_VF_STATE_PRE_ENABLE, &vfs[i].vf_states); 1859 1860 } 1861 pf->num_alloc_vfs = num_alloc_vfs; 1862 1863 /* VF resources get allocated during reset */ 1864 i40e_reset_all_vfs(pf, false); 1865 1866 i40e_notify_client_of_vf_enable(pf, num_alloc_vfs); 1867 1868 err_alloc: 1869 if (ret) 1870 i40e_free_vfs(pf); 1871 err_iov: 1872 /* Re-enable interrupt 0. */ 1873 i40e_irq_dynamic_enable_icr0(pf); 1874 return ret; 1875 } 1876 1877 #endif 1878 /** 1879 * i40e_pci_sriov_enable 1880 * @pdev: pointer to a pci_dev structure 1881 * @num_vfs: number of VFs to allocate 1882 * 1883 * Enable or change the number of VFs 1884 **/ 1885 static int i40e_pci_sriov_enable(struct pci_dev *pdev, int num_vfs) 1886 { 1887 #ifdef CONFIG_PCI_IOV 1888 struct i40e_pf *pf = pci_get_drvdata(pdev); 1889 int pre_existing_vfs = pci_num_vf(pdev); 1890 int err = 0; 1891 1892 if (test_bit(__I40E_TESTING, pf->state)) { 1893 dev_warn(&pdev->dev, 1894 "Cannot enable SR-IOV virtual functions while the device is undergoing diagnostic testing\n"); 1895 err = -EPERM; 1896 goto err_out; 1897 } 1898 1899 if (pre_existing_vfs && pre_existing_vfs != num_vfs) 1900 i40e_free_vfs(pf); 1901 else if (pre_existing_vfs && pre_existing_vfs == num_vfs) 1902 goto out; 1903 1904 if (num_vfs > pf->num_req_vfs) { 1905 dev_warn(&pdev->dev, "Unable to enable %d VFs. Limited to %d VFs due to device resource constraints.\n", 1906 num_vfs, pf->num_req_vfs); 1907 err = -EPERM; 1908 goto err_out; 1909 } 1910 1911 dev_info(&pdev->dev, "Allocating %d VFs.\n", num_vfs); 1912 err = i40e_alloc_vfs(pf, num_vfs); 1913 if (err) { 1914 dev_warn(&pdev->dev, "Failed to enable SR-IOV: %d\n", err); 1915 goto err_out; 1916 } 1917 1918 out: 1919 return num_vfs; 1920 1921 err_out: 1922 return err; 1923 #endif 1924 return 0; 1925 } 1926 1927 /** 1928 * i40e_pci_sriov_configure 1929 * @pdev: pointer to a pci_dev structure 1930 * @num_vfs: number of VFs to allocate 1931 * 1932 * Enable or change the number of VFs. Called when the user updates the number 1933 * of VFs in sysfs. 1934 **/ 1935 int i40e_pci_sriov_configure(struct pci_dev *pdev, int num_vfs) 1936 { 1937 struct i40e_pf *pf = pci_get_drvdata(pdev); 1938 int ret = 0; 1939 1940 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 1941 dev_warn(&pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 1942 return -EAGAIN; 1943 } 1944 1945 if (num_vfs) { 1946 if (!(pf->flags & I40E_FLAG_VEB_MODE_ENABLED)) { 1947 pf->flags |= I40E_FLAG_VEB_MODE_ENABLED; 1948 i40e_do_reset_safe(pf, I40E_PF_RESET_AND_REBUILD_FLAG); 1949 } 1950 ret = i40e_pci_sriov_enable(pdev, num_vfs); 1951 goto sriov_configure_out; 1952 } 1953 1954 if (!pci_vfs_assigned(pf->pdev)) { 1955 i40e_free_vfs(pf); 1956 pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED; 1957 i40e_do_reset_safe(pf, I40E_PF_RESET_AND_REBUILD_FLAG); 1958 } else { 1959 dev_warn(&pdev->dev, "Unable to free VFs because some are assigned to VMs.\n"); 1960 ret = -EINVAL; 1961 goto sriov_configure_out; 1962 } 1963 sriov_configure_out: 1964 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 1965 return ret; 1966 } 1967 1968 /***********************virtual channel routines******************/ 1969 1970 /** 1971 * i40e_vc_send_msg_to_vf 1972 * @vf: pointer to the VF info 1973 * @v_opcode: virtual channel opcode 1974 * @v_retval: virtual channel return value 1975 * @msg: pointer to the msg buffer 1976 * @msglen: msg length 1977 * 1978 * send msg to VF 1979 **/ 1980 static int i40e_vc_send_msg_to_vf(struct i40e_vf *vf, u32 v_opcode, 1981 u32 v_retval, u8 *msg, u16 msglen) 1982 { 1983 struct i40e_pf *pf; 1984 struct i40e_hw *hw; 1985 int abs_vf_id; 1986 int aq_ret; 1987 1988 /* validate the request */ 1989 if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs) 1990 return -EINVAL; 1991 1992 pf = vf->pf; 1993 hw = &pf->hw; 1994 abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 1995 1996 aq_ret = i40e_aq_send_msg_to_vf(hw, abs_vf_id, v_opcode, v_retval, 1997 msg, msglen, NULL); 1998 if (aq_ret) { 1999 dev_info(&pf->pdev->dev, 2000 "Unable to send the message to VF %d aq_err %d\n", 2001 vf->vf_id, pf->hw.aq.asq_last_status); 2002 return -EIO; 2003 } 2004 2005 return 0; 2006 } 2007 2008 /** 2009 * i40e_vc_send_resp_to_vf 2010 * @vf: pointer to the VF info 2011 * @opcode: operation code 2012 * @retval: return value 2013 * 2014 * send resp msg to VF 2015 **/ 2016 static int i40e_vc_send_resp_to_vf(struct i40e_vf *vf, 2017 enum virtchnl_ops opcode, 2018 int retval) 2019 { 2020 return i40e_vc_send_msg_to_vf(vf, opcode, retval, NULL, 0); 2021 } 2022 2023 /** 2024 * i40e_sync_vf_state 2025 * @vf: pointer to the VF info 2026 * @state: VF state 2027 * 2028 * Called from a VF message to synchronize the service with a potential 2029 * VF reset state 2030 **/ 2031 static bool i40e_sync_vf_state(struct i40e_vf *vf, enum i40e_vf_states state) 2032 { 2033 int i; 2034 2035 /* When handling some messages, it needs VF state to be set. 2036 * It is possible that this flag is cleared during VF reset, 2037 * so there is a need to wait until the end of the reset to 2038 * handle the request message correctly. 2039 */ 2040 for (i = 0; i < I40E_VF_STATE_WAIT_COUNT; i++) { 2041 if (test_bit(state, &vf->vf_states)) 2042 return true; 2043 usleep_range(10000, 20000); 2044 } 2045 2046 return test_bit(state, &vf->vf_states); 2047 } 2048 2049 /** 2050 * i40e_vc_get_version_msg 2051 * @vf: pointer to the VF info 2052 * @msg: pointer to the msg buffer 2053 * 2054 * called from the VF to request the API version used by the PF 2055 **/ 2056 static int i40e_vc_get_version_msg(struct i40e_vf *vf, u8 *msg) 2057 { 2058 struct virtchnl_version_info info = { 2059 VIRTCHNL_VERSION_MAJOR, VIRTCHNL_VERSION_MINOR 2060 }; 2061 2062 vf->vf_ver = *(struct virtchnl_version_info *)msg; 2063 /* VFs running the 1.0 API expect to get 1.0 back or they will cry. */ 2064 if (VF_IS_V10(&vf->vf_ver)) 2065 info.minor = VIRTCHNL_VERSION_MINOR_NO_VF_CAPS; 2066 return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_VERSION, 2067 0, (u8 *)&info, 2068 sizeof(struct virtchnl_version_info)); 2069 } 2070 2071 /** 2072 * i40e_del_qch - delete all the additional VSIs created as a part of ADq 2073 * @vf: pointer to VF structure 2074 **/ 2075 static void i40e_del_qch(struct i40e_vf *vf) 2076 { 2077 struct i40e_pf *pf = vf->pf; 2078 int i; 2079 2080 /* first element in the array belongs to primary VF VSI and we shouldn't 2081 * delete it. We should however delete the rest of the VSIs created 2082 */ 2083 for (i = 1; i < vf->num_tc; i++) { 2084 if (vf->ch[i].vsi_idx) { 2085 i40e_vsi_release(pf->vsi[vf->ch[i].vsi_idx]); 2086 vf->ch[i].vsi_idx = 0; 2087 vf->ch[i].vsi_id = 0; 2088 } 2089 } 2090 } 2091 2092 /** 2093 * i40e_vc_get_max_frame_size 2094 * @vf: pointer to the VF 2095 * 2096 * Max frame size is determined based on the current port's max frame size and 2097 * whether a port VLAN is configured on this VF. The VF is not aware whether 2098 * it's in a port VLAN so the PF needs to account for this in max frame size 2099 * checks and sending the max frame size to the VF. 2100 **/ 2101 static u16 i40e_vc_get_max_frame_size(struct i40e_vf *vf) 2102 { 2103 u16 max_frame_size = vf->pf->hw.phy.link_info.max_frame_size; 2104 2105 if (vf->port_vlan_id) 2106 max_frame_size -= VLAN_HLEN; 2107 2108 return max_frame_size; 2109 } 2110 2111 /** 2112 * i40e_vc_get_vf_resources_msg 2113 * @vf: pointer to the VF info 2114 * @msg: pointer to the msg buffer 2115 * 2116 * called from the VF to request its resources 2117 **/ 2118 static int i40e_vc_get_vf_resources_msg(struct i40e_vf *vf, u8 *msg) 2119 { 2120 struct virtchnl_vf_resource *vfres = NULL; 2121 struct i40e_pf *pf = vf->pf; 2122 struct i40e_vsi *vsi; 2123 int num_vsis = 1; 2124 int aq_ret = 0; 2125 size_t len = 0; 2126 int ret; 2127 2128 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_INIT)) { 2129 aq_ret = -EINVAL; 2130 goto err; 2131 } 2132 2133 len = virtchnl_struct_size(vfres, vsi_res, num_vsis); 2134 vfres = kzalloc(len, GFP_KERNEL); 2135 if (!vfres) { 2136 aq_ret = -ENOMEM; 2137 len = 0; 2138 goto err; 2139 } 2140 if (VF_IS_V11(&vf->vf_ver)) 2141 vf->driver_caps = *(u32 *)msg; 2142 else 2143 vf->driver_caps = VIRTCHNL_VF_OFFLOAD_L2 | 2144 VIRTCHNL_VF_OFFLOAD_RSS_REG | 2145 VIRTCHNL_VF_OFFLOAD_VLAN; 2146 2147 vfres->vf_cap_flags = VIRTCHNL_VF_OFFLOAD_L2; 2148 vfres->vf_cap_flags |= VIRTCHNL_VF_CAP_ADV_LINK_SPEED; 2149 vsi = pf->vsi[vf->lan_vsi_idx]; 2150 if (!vsi->info.pvid) 2151 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_VLAN; 2152 2153 if (i40e_vf_client_capable(pf, vf->vf_id) && 2154 (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RDMA)) { 2155 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RDMA; 2156 set_bit(I40E_VF_STATE_RDMAENA, &vf->vf_states); 2157 } else { 2158 clear_bit(I40E_VF_STATE_RDMAENA, &vf->vf_states); 2159 } 2160 2161 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PF) { 2162 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_PF; 2163 } else { 2164 if ((pf->hw_features & I40E_HW_RSS_AQ_CAPABLE) && 2165 (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_AQ)) 2166 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_AQ; 2167 else 2168 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_REG; 2169 } 2170 2171 if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) { 2172 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2) 2173 vfres->vf_cap_flags |= 2174 VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2; 2175 } 2176 2177 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP) 2178 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP; 2179 2180 if ((pf->hw_features & I40E_HW_OUTER_UDP_CSUM_CAPABLE) && 2181 (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM)) 2182 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM; 2183 2184 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_POLLING) { 2185 if (pf->flags & I40E_FLAG_MFP_ENABLED) { 2186 dev_err(&pf->pdev->dev, 2187 "VF %d requested polling mode: this feature is supported only when the device is running in single function per port (SFP) mode\n", 2188 vf->vf_id); 2189 aq_ret = -EINVAL; 2190 goto err; 2191 } 2192 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RX_POLLING; 2193 } 2194 2195 if (pf->hw_features & I40E_HW_WB_ON_ITR_CAPABLE) { 2196 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_WB_ON_ITR) 2197 vfres->vf_cap_flags |= 2198 VIRTCHNL_VF_OFFLOAD_WB_ON_ITR; 2199 } 2200 2201 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_REQ_QUEUES) 2202 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_REQ_QUEUES; 2203 2204 if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ADQ) 2205 vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ADQ; 2206 2207 vfres->num_vsis = num_vsis; 2208 vfres->num_queue_pairs = vf->num_queue_pairs; 2209 vfres->max_vectors = pf->hw.func_caps.num_msix_vectors_vf; 2210 vfres->rss_key_size = I40E_HKEY_ARRAY_SIZE; 2211 vfres->rss_lut_size = I40E_VF_HLUT_ARRAY_SIZE; 2212 vfres->max_mtu = i40e_vc_get_max_frame_size(vf); 2213 2214 if (vf->lan_vsi_idx) { 2215 vfres->vsi_res[0].vsi_id = vf->lan_vsi_id; 2216 vfres->vsi_res[0].vsi_type = VIRTCHNL_VSI_SRIOV; 2217 vfres->vsi_res[0].num_queue_pairs = vsi->alloc_queue_pairs; 2218 /* VFs only use TC 0 */ 2219 vfres->vsi_res[0].qset_handle 2220 = le16_to_cpu(vsi->info.qs_handle[0]); 2221 if (!(vf->driver_caps & VIRTCHNL_VF_OFFLOAD_USO) && !vf->pf_set_mac) { 2222 i40e_del_mac_filter(vsi, vf->default_lan_addr.addr); 2223 eth_zero_addr(vf->default_lan_addr.addr); 2224 } 2225 ether_addr_copy(vfres->vsi_res[0].default_mac_addr, 2226 vf->default_lan_addr.addr); 2227 } 2228 set_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states); 2229 2230 err: 2231 /* send the response back to the VF */ 2232 ret = i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_VF_RESOURCES, 2233 aq_ret, (u8 *)vfres, len); 2234 2235 kfree(vfres); 2236 return ret; 2237 } 2238 2239 /** 2240 * i40e_vc_config_promiscuous_mode_msg 2241 * @vf: pointer to the VF info 2242 * @msg: pointer to the msg buffer 2243 * 2244 * called from the VF to configure the promiscuous mode of 2245 * VF vsis 2246 **/ 2247 static int i40e_vc_config_promiscuous_mode_msg(struct i40e_vf *vf, u8 *msg) 2248 { 2249 struct virtchnl_promisc_info *info = 2250 (struct virtchnl_promisc_info *)msg; 2251 struct i40e_pf *pf = vf->pf; 2252 bool allmulti = false; 2253 bool alluni = false; 2254 int aq_ret = 0; 2255 2256 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 2257 aq_ret = -EINVAL; 2258 goto err_out; 2259 } 2260 if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 2261 dev_err(&pf->pdev->dev, 2262 "Unprivileged VF %d is attempting to configure promiscuous mode\n", 2263 vf->vf_id); 2264 2265 /* Lie to the VF on purpose, because this is an error we can 2266 * ignore. Unprivileged VF is not a virtual channel error. 2267 */ 2268 aq_ret = 0; 2269 goto err_out; 2270 } 2271 2272 if (info->flags > I40E_MAX_VF_PROMISC_FLAGS) { 2273 aq_ret = -EINVAL; 2274 goto err_out; 2275 } 2276 2277 if (!i40e_vc_isvalid_vsi_id(vf, info->vsi_id)) { 2278 aq_ret = -EINVAL; 2279 goto err_out; 2280 } 2281 2282 /* Multicast promiscuous handling*/ 2283 if (info->flags & FLAG_VF_MULTICAST_PROMISC) 2284 allmulti = true; 2285 2286 if (info->flags & FLAG_VF_UNICAST_PROMISC) 2287 alluni = true; 2288 aq_ret = i40e_config_vf_promiscuous_mode(vf, info->vsi_id, allmulti, 2289 alluni); 2290 if (aq_ret) 2291 goto err_out; 2292 2293 if (allmulti) { 2294 if (!test_and_set_bit(I40E_VF_STATE_MC_PROMISC, 2295 &vf->vf_states)) 2296 dev_info(&pf->pdev->dev, 2297 "VF %d successfully set multicast promiscuous mode\n", 2298 vf->vf_id); 2299 } else if (test_and_clear_bit(I40E_VF_STATE_MC_PROMISC, 2300 &vf->vf_states)) 2301 dev_info(&pf->pdev->dev, 2302 "VF %d successfully unset multicast promiscuous mode\n", 2303 vf->vf_id); 2304 2305 if (alluni) { 2306 if (!test_and_set_bit(I40E_VF_STATE_UC_PROMISC, 2307 &vf->vf_states)) 2308 dev_info(&pf->pdev->dev, 2309 "VF %d successfully set unicast promiscuous mode\n", 2310 vf->vf_id); 2311 } else if (test_and_clear_bit(I40E_VF_STATE_UC_PROMISC, 2312 &vf->vf_states)) 2313 dev_info(&pf->pdev->dev, 2314 "VF %d successfully unset unicast promiscuous mode\n", 2315 vf->vf_id); 2316 2317 err_out: 2318 /* send the response to the VF */ 2319 return i40e_vc_send_resp_to_vf(vf, 2320 VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE, 2321 aq_ret); 2322 } 2323 2324 /** 2325 * i40e_vc_config_queues_msg 2326 * @vf: pointer to the VF info 2327 * @msg: pointer to the msg buffer 2328 * 2329 * called from the VF to configure the rx/tx 2330 * queues 2331 **/ 2332 static int i40e_vc_config_queues_msg(struct i40e_vf *vf, u8 *msg) 2333 { 2334 struct virtchnl_vsi_queue_config_info *qci = 2335 (struct virtchnl_vsi_queue_config_info *)msg; 2336 struct virtchnl_queue_pair_info *qpi; 2337 u16 vsi_id, vsi_queue_id = 0; 2338 struct i40e_pf *pf = vf->pf; 2339 int i, j = 0, idx = 0; 2340 struct i40e_vsi *vsi; 2341 u16 num_qps_all = 0; 2342 int aq_ret = 0; 2343 2344 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 2345 aq_ret = -EINVAL; 2346 goto error_param; 2347 } 2348 2349 if (!i40e_vc_isvalid_vsi_id(vf, qci->vsi_id)) { 2350 aq_ret = -EINVAL; 2351 goto error_param; 2352 } 2353 2354 if (qci->num_queue_pairs > I40E_MAX_VF_QUEUES) { 2355 aq_ret = -EINVAL; 2356 goto error_param; 2357 } 2358 2359 if (vf->adq_enabled) { 2360 for (i = 0; i < vf->num_tc; i++) 2361 num_qps_all += vf->ch[i].num_qps; 2362 if (num_qps_all != qci->num_queue_pairs) { 2363 aq_ret = -EINVAL; 2364 goto error_param; 2365 } 2366 } 2367 2368 vsi_id = qci->vsi_id; 2369 2370 for (i = 0; i < qci->num_queue_pairs; i++) { 2371 qpi = &qci->qpair[i]; 2372 2373 if (!vf->adq_enabled) { 2374 if (!i40e_vc_isvalid_queue_id(vf, vsi_id, 2375 qpi->txq.queue_id)) { 2376 aq_ret = -EINVAL; 2377 goto error_param; 2378 } 2379 2380 vsi_queue_id = qpi->txq.queue_id; 2381 2382 if (qpi->txq.vsi_id != qci->vsi_id || 2383 qpi->rxq.vsi_id != qci->vsi_id || 2384 qpi->rxq.queue_id != vsi_queue_id) { 2385 aq_ret = -EINVAL; 2386 goto error_param; 2387 } 2388 } 2389 2390 if (vf->adq_enabled) { 2391 if (idx >= ARRAY_SIZE(vf->ch)) { 2392 aq_ret = -ENODEV; 2393 goto error_param; 2394 } 2395 vsi_id = vf->ch[idx].vsi_id; 2396 } 2397 2398 if (i40e_config_vsi_rx_queue(vf, vsi_id, vsi_queue_id, 2399 &qpi->rxq) || 2400 i40e_config_vsi_tx_queue(vf, vsi_id, vsi_queue_id, 2401 &qpi->txq)) { 2402 aq_ret = -EINVAL; 2403 goto error_param; 2404 } 2405 2406 /* For ADq there can be up to 4 VSIs with max 4 queues each. 2407 * VF does not know about these additional VSIs and all 2408 * it cares is about its own queues. PF configures these queues 2409 * to its appropriate VSIs based on TC mapping 2410 */ 2411 if (vf->adq_enabled) { 2412 if (idx >= ARRAY_SIZE(vf->ch)) { 2413 aq_ret = -ENODEV; 2414 goto error_param; 2415 } 2416 if (j == (vf->ch[idx].num_qps - 1)) { 2417 idx++; 2418 j = 0; /* resetting the queue count */ 2419 vsi_queue_id = 0; 2420 } else { 2421 j++; 2422 vsi_queue_id++; 2423 } 2424 } 2425 } 2426 /* set vsi num_queue_pairs in use to num configured by VF */ 2427 if (!vf->adq_enabled) { 2428 pf->vsi[vf->lan_vsi_idx]->num_queue_pairs = 2429 qci->num_queue_pairs; 2430 } else { 2431 for (i = 0; i < vf->num_tc; i++) { 2432 vsi = pf->vsi[vf->ch[i].vsi_idx]; 2433 vsi->num_queue_pairs = vf->ch[i].num_qps; 2434 2435 if (i40e_update_adq_vsi_queues(vsi, i)) { 2436 aq_ret = -EIO; 2437 goto error_param; 2438 } 2439 } 2440 } 2441 2442 error_param: 2443 /* send the response to the VF */ 2444 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_VSI_QUEUES, 2445 aq_ret); 2446 } 2447 2448 /** 2449 * i40e_validate_queue_map - check queue map is valid 2450 * @vf: the VF structure pointer 2451 * @vsi_id: vsi id 2452 * @queuemap: Tx or Rx queue map 2453 * 2454 * check if Tx or Rx queue map is valid 2455 **/ 2456 static int i40e_validate_queue_map(struct i40e_vf *vf, u16 vsi_id, 2457 unsigned long queuemap) 2458 { 2459 u16 vsi_queue_id, queue_id; 2460 2461 for_each_set_bit(vsi_queue_id, &queuemap, I40E_MAX_VSI_QP) { 2462 if (vf->adq_enabled) { 2463 vsi_id = vf->ch[vsi_queue_id / I40E_MAX_VF_VSI].vsi_id; 2464 queue_id = (vsi_queue_id % I40E_DEFAULT_QUEUES_PER_VF); 2465 } else { 2466 queue_id = vsi_queue_id; 2467 } 2468 2469 if (!i40e_vc_isvalid_queue_id(vf, vsi_id, queue_id)) 2470 return -EINVAL; 2471 } 2472 2473 return 0; 2474 } 2475 2476 /** 2477 * i40e_vc_config_irq_map_msg 2478 * @vf: pointer to the VF info 2479 * @msg: pointer to the msg buffer 2480 * 2481 * called from the VF to configure the irq to 2482 * queue map 2483 **/ 2484 static int i40e_vc_config_irq_map_msg(struct i40e_vf *vf, u8 *msg) 2485 { 2486 struct virtchnl_irq_map_info *irqmap_info = 2487 (struct virtchnl_irq_map_info *)msg; 2488 struct virtchnl_vector_map *map; 2489 int aq_ret = 0; 2490 u16 vsi_id; 2491 int i; 2492 2493 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 2494 aq_ret = -EINVAL; 2495 goto error_param; 2496 } 2497 2498 if (irqmap_info->num_vectors > 2499 vf->pf->hw.func_caps.num_msix_vectors_vf) { 2500 aq_ret = -EINVAL; 2501 goto error_param; 2502 } 2503 2504 for (i = 0; i < irqmap_info->num_vectors; i++) { 2505 map = &irqmap_info->vecmap[i]; 2506 /* validate msg params */ 2507 if (!i40e_vc_isvalid_vector_id(vf, map->vector_id) || 2508 !i40e_vc_isvalid_vsi_id(vf, map->vsi_id)) { 2509 aq_ret = -EINVAL; 2510 goto error_param; 2511 } 2512 vsi_id = map->vsi_id; 2513 2514 if (i40e_validate_queue_map(vf, vsi_id, map->rxq_map)) { 2515 aq_ret = -EINVAL; 2516 goto error_param; 2517 } 2518 2519 if (i40e_validate_queue_map(vf, vsi_id, map->txq_map)) { 2520 aq_ret = -EINVAL; 2521 goto error_param; 2522 } 2523 2524 i40e_config_irq_link_list(vf, vsi_id, map); 2525 } 2526 error_param: 2527 /* send the response to the VF */ 2528 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_IRQ_MAP, 2529 aq_ret); 2530 } 2531 2532 /** 2533 * i40e_ctrl_vf_tx_rings 2534 * @vsi: the SRIOV VSI being configured 2535 * @q_map: bit map of the queues to be enabled 2536 * @enable: start or stop the queue 2537 **/ 2538 static int i40e_ctrl_vf_tx_rings(struct i40e_vsi *vsi, unsigned long q_map, 2539 bool enable) 2540 { 2541 struct i40e_pf *pf = vsi->back; 2542 int ret = 0; 2543 u16 q_id; 2544 2545 for_each_set_bit(q_id, &q_map, I40E_MAX_VF_QUEUES) { 2546 ret = i40e_control_wait_tx_q(vsi->seid, pf, 2547 vsi->base_queue + q_id, 2548 false /*is xdp*/, enable); 2549 if (ret) 2550 break; 2551 } 2552 return ret; 2553 } 2554 2555 /** 2556 * i40e_ctrl_vf_rx_rings 2557 * @vsi: the SRIOV VSI being configured 2558 * @q_map: bit map of the queues to be enabled 2559 * @enable: start or stop the queue 2560 **/ 2561 static int i40e_ctrl_vf_rx_rings(struct i40e_vsi *vsi, unsigned long q_map, 2562 bool enable) 2563 { 2564 struct i40e_pf *pf = vsi->back; 2565 int ret = 0; 2566 u16 q_id; 2567 2568 for_each_set_bit(q_id, &q_map, I40E_MAX_VF_QUEUES) { 2569 ret = i40e_control_wait_rx_q(pf, vsi->base_queue + q_id, 2570 enable); 2571 if (ret) 2572 break; 2573 } 2574 return ret; 2575 } 2576 2577 /** 2578 * i40e_vc_validate_vqs_bitmaps - validate Rx/Tx queue bitmaps from VIRTHCHNL 2579 * @vqs: virtchnl_queue_select structure containing bitmaps to validate 2580 * 2581 * Returns true if validation was successful, else false. 2582 */ 2583 static bool i40e_vc_validate_vqs_bitmaps(struct virtchnl_queue_select *vqs) 2584 { 2585 if ((!vqs->rx_queues && !vqs->tx_queues) || 2586 vqs->rx_queues >= BIT(I40E_MAX_VF_QUEUES) || 2587 vqs->tx_queues >= BIT(I40E_MAX_VF_QUEUES)) 2588 return false; 2589 2590 return true; 2591 } 2592 2593 /** 2594 * i40e_vc_enable_queues_msg 2595 * @vf: pointer to the VF info 2596 * @msg: pointer to the msg buffer 2597 * 2598 * called from the VF to enable all or specific queue(s) 2599 **/ 2600 static int i40e_vc_enable_queues_msg(struct i40e_vf *vf, u8 *msg) 2601 { 2602 struct virtchnl_queue_select *vqs = 2603 (struct virtchnl_queue_select *)msg; 2604 struct i40e_pf *pf = vf->pf; 2605 int aq_ret = 0; 2606 int i; 2607 2608 if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) { 2609 aq_ret = -EINVAL; 2610 goto error_param; 2611 } 2612 2613 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) { 2614 aq_ret = -EINVAL; 2615 goto error_param; 2616 } 2617 2618 if (!i40e_vc_validate_vqs_bitmaps(vqs)) { 2619 aq_ret = -EINVAL; 2620 goto error_param; 2621 } 2622 2623 /* Use the queue bit map sent by the VF */ 2624 if (i40e_ctrl_vf_rx_rings(pf->vsi[vf->lan_vsi_idx], vqs->rx_queues, 2625 true)) { 2626 aq_ret = -EIO; 2627 goto error_param; 2628 } 2629 if (i40e_ctrl_vf_tx_rings(pf->vsi[vf->lan_vsi_idx], vqs->tx_queues, 2630 true)) { 2631 aq_ret = -EIO; 2632 goto error_param; 2633 } 2634 2635 /* need to start the rings for additional ADq VSI's as well */ 2636 if (vf->adq_enabled) { 2637 /* zero belongs to LAN VSI */ 2638 for (i = 1; i < vf->num_tc; i++) { 2639 if (i40e_vsi_start_rings(pf->vsi[vf->ch[i].vsi_idx])) 2640 aq_ret = -EIO; 2641 } 2642 } 2643 2644 error_param: 2645 /* send the response to the VF */ 2646 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_QUEUES, 2647 aq_ret); 2648 } 2649 2650 /** 2651 * i40e_vc_disable_queues_msg 2652 * @vf: pointer to the VF info 2653 * @msg: pointer to the msg buffer 2654 * 2655 * called from the VF to disable all or specific 2656 * queue(s) 2657 **/ 2658 static int i40e_vc_disable_queues_msg(struct i40e_vf *vf, u8 *msg) 2659 { 2660 struct virtchnl_queue_select *vqs = 2661 (struct virtchnl_queue_select *)msg; 2662 struct i40e_pf *pf = vf->pf; 2663 int aq_ret = 0; 2664 2665 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 2666 aq_ret = -EINVAL; 2667 goto error_param; 2668 } 2669 2670 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) { 2671 aq_ret = -EINVAL; 2672 goto error_param; 2673 } 2674 2675 if (!i40e_vc_validate_vqs_bitmaps(vqs)) { 2676 aq_ret = -EINVAL; 2677 goto error_param; 2678 } 2679 2680 /* Use the queue bit map sent by the VF */ 2681 if (i40e_ctrl_vf_tx_rings(pf->vsi[vf->lan_vsi_idx], vqs->tx_queues, 2682 false)) { 2683 aq_ret = -EIO; 2684 goto error_param; 2685 } 2686 if (i40e_ctrl_vf_rx_rings(pf->vsi[vf->lan_vsi_idx], vqs->rx_queues, 2687 false)) { 2688 aq_ret = -EIO; 2689 goto error_param; 2690 } 2691 error_param: 2692 /* send the response to the VF */ 2693 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_QUEUES, 2694 aq_ret); 2695 } 2696 2697 /** 2698 * i40e_check_enough_queue - find big enough queue number 2699 * @vf: pointer to the VF info 2700 * @needed: the number of items needed 2701 * 2702 * Returns the base item index of the queue, or negative for error 2703 **/ 2704 static int i40e_check_enough_queue(struct i40e_vf *vf, u16 needed) 2705 { 2706 unsigned int i, cur_queues, more, pool_size; 2707 struct i40e_lump_tracking *pile; 2708 struct i40e_pf *pf = vf->pf; 2709 struct i40e_vsi *vsi; 2710 2711 vsi = pf->vsi[vf->lan_vsi_idx]; 2712 cur_queues = vsi->alloc_queue_pairs; 2713 2714 /* if current allocated queues are enough for need */ 2715 if (cur_queues >= needed) 2716 return vsi->base_queue; 2717 2718 pile = pf->qp_pile; 2719 if (cur_queues > 0) { 2720 /* if the allocated queues are not zero 2721 * just check if there are enough queues for more 2722 * behind the allocated queues. 2723 */ 2724 more = needed - cur_queues; 2725 for (i = vsi->base_queue + cur_queues; 2726 i < pile->num_entries; i++) { 2727 if (pile->list[i] & I40E_PILE_VALID_BIT) 2728 break; 2729 2730 if (more-- == 1) 2731 /* there is enough */ 2732 return vsi->base_queue; 2733 } 2734 } 2735 2736 pool_size = 0; 2737 for (i = 0; i < pile->num_entries; i++) { 2738 if (pile->list[i] & I40E_PILE_VALID_BIT) { 2739 pool_size = 0; 2740 continue; 2741 } 2742 if (needed <= ++pool_size) 2743 /* there is enough */ 2744 return i; 2745 } 2746 2747 return -ENOMEM; 2748 } 2749 2750 /** 2751 * i40e_vc_request_queues_msg 2752 * @vf: pointer to the VF info 2753 * @msg: pointer to the msg buffer 2754 * 2755 * VFs get a default number of queues but can use this message to request a 2756 * different number. If the request is successful, PF will reset the VF and 2757 * return 0. If unsuccessful, PF will send message informing VF of number of 2758 * available queues and return result of sending VF a message. 2759 **/ 2760 static int i40e_vc_request_queues_msg(struct i40e_vf *vf, u8 *msg) 2761 { 2762 struct virtchnl_vf_res_request *vfres = 2763 (struct virtchnl_vf_res_request *)msg; 2764 u16 req_pairs = vfres->num_queue_pairs; 2765 u8 cur_pairs = vf->num_queue_pairs; 2766 struct i40e_pf *pf = vf->pf; 2767 2768 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) 2769 return -EINVAL; 2770 2771 if (req_pairs > I40E_MAX_VF_QUEUES) { 2772 dev_err(&pf->pdev->dev, 2773 "VF %d tried to request more than %d queues.\n", 2774 vf->vf_id, 2775 I40E_MAX_VF_QUEUES); 2776 vfres->num_queue_pairs = I40E_MAX_VF_QUEUES; 2777 } else if (req_pairs - cur_pairs > pf->queues_left) { 2778 dev_warn(&pf->pdev->dev, 2779 "VF %d requested %d more queues, but only %d left.\n", 2780 vf->vf_id, 2781 req_pairs - cur_pairs, 2782 pf->queues_left); 2783 vfres->num_queue_pairs = pf->queues_left + cur_pairs; 2784 } else if (i40e_check_enough_queue(vf, req_pairs) < 0) { 2785 dev_warn(&pf->pdev->dev, 2786 "VF %d requested %d more queues, but there is not enough for it.\n", 2787 vf->vf_id, 2788 req_pairs - cur_pairs); 2789 vfres->num_queue_pairs = cur_pairs; 2790 } else { 2791 /* successful request */ 2792 vf->num_req_queues = req_pairs; 2793 i40e_vc_reset_vf(vf, true); 2794 return 0; 2795 } 2796 2797 return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_REQUEST_QUEUES, 0, 2798 (u8 *)vfres, sizeof(*vfres)); 2799 } 2800 2801 /** 2802 * i40e_vc_get_stats_msg 2803 * @vf: pointer to the VF info 2804 * @msg: pointer to the msg buffer 2805 * 2806 * called from the VF to get vsi stats 2807 **/ 2808 static int i40e_vc_get_stats_msg(struct i40e_vf *vf, u8 *msg) 2809 { 2810 struct virtchnl_queue_select *vqs = 2811 (struct virtchnl_queue_select *)msg; 2812 struct i40e_pf *pf = vf->pf; 2813 struct i40e_eth_stats stats; 2814 int aq_ret = 0; 2815 struct i40e_vsi *vsi; 2816 2817 memset(&stats, 0, sizeof(struct i40e_eth_stats)); 2818 2819 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 2820 aq_ret = -EINVAL; 2821 goto error_param; 2822 } 2823 2824 if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) { 2825 aq_ret = -EINVAL; 2826 goto error_param; 2827 } 2828 2829 vsi = pf->vsi[vf->lan_vsi_idx]; 2830 if (!vsi) { 2831 aq_ret = -EINVAL; 2832 goto error_param; 2833 } 2834 i40e_update_eth_stats(vsi); 2835 stats = vsi->eth_stats; 2836 2837 error_param: 2838 /* send the response back to the VF */ 2839 return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_STATS, aq_ret, 2840 (u8 *)&stats, sizeof(stats)); 2841 } 2842 2843 #define I40E_MAX_MACVLAN_PER_HW 3072 2844 #define I40E_MAX_MACVLAN_PER_PF(num_ports) (I40E_MAX_MACVLAN_PER_HW / \ 2845 (num_ports)) 2846 /* If the VF is not trusted restrict the number of MAC/VLAN it can program 2847 * MAC filters: 16 for multicast, 1 for MAC, 1 for broadcast 2848 */ 2849 #define I40E_VC_MAX_MAC_ADDR_PER_VF (16 + 1 + 1) 2850 #define I40E_VC_MAX_VLAN_PER_VF 16 2851 2852 #define I40E_VC_MAX_MACVLAN_PER_TRUSTED_VF(vf_num, num_ports) \ 2853 ({ typeof(vf_num) vf_num_ = (vf_num); \ 2854 typeof(num_ports) num_ports_ = (num_ports); \ 2855 ((I40E_MAX_MACVLAN_PER_PF(num_ports_) - vf_num_ * \ 2856 I40E_VC_MAX_MAC_ADDR_PER_VF) / vf_num_) + \ 2857 I40E_VC_MAX_MAC_ADDR_PER_VF; }) 2858 /** 2859 * i40e_check_vf_permission 2860 * @vf: pointer to the VF info 2861 * @al: MAC address list from virtchnl 2862 * 2863 * Check that the given list of MAC addresses is allowed. Will return -EPERM 2864 * if any address in the list is not valid. Checks the following conditions: 2865 * 2866 * 1) broadcast and zero addresses are never valid 2867 * 2) unicast addresses are not allowed if the VMM has administratively set 2868 * the VF MAC address, unless the VF is marked as privileged. 2869 * 3) There is enough space to add all the addresses. 2870 * 2871 * Note that to guarantee consistency, it is expected this function be called 2872 * while holding the mac_filter_hash_lock, as otherwise the current number of 2873 * addresses might not be accurate. 2874 **/ 2875 static inline int i40e_check_vf_permission(struct i40e_vf *vf, 2876 struct virtchnl_ether_addr_list *al) 2877 { 2878 struct i40e_pf *pf = vf->pf; 2879 struct i40e_vsi *vsi = pf->vsi[vf->lan_vsi_idx]; 2880 struct i40e_hw *hw = &pf->hw; 2881 int mac2add_cnt = 0; 2882 int i; 2883 2884 for (i = 0; i < al->num_elements; i++) { 2885 struct i40e_mac_filter *f; 2886 u8 *addr = al->list[i].addr; 2887 2888 if (is_broadcast_ether_addr(addr) || 2889 is_zero_ether_addr(addr)) { 2890 dev_err(&pf->pdev->dev, "invalid VF MAC addr %pM\n", 2891 addr); 2892 return -EINVAL; 2893 } 2894 2895 /* If the host VMM administrator has set the VF MAC address 2896 * administratively via the ndo_set_vf_mac command then deny 2897 * permission to the VF to add or delete unicast MAC addresses. 2898 * Unless the VF is privileged and then it can do whatever. 2899 * The VF may request to set the MAC address filter already 2900 * assigned to it so do not return an error in that case. 2901 */ 2902 if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) && 2903 !is_multicast_ether_addr(addr) && vf->pf_set_mac && 2904 !ether_addr_equal(addr, vf->default_lan_addr.addr)) { 2905 dev_err(&pf->pdev->dev, 2906 "VF attempting to override administratively set MAC address, bring down and up the VF interface to resume normal operation\n"); 2907 return -EPERM; 2908 } 2909 2910 /*count filters that really will be added*/ 2911 f = i40e_find_mac(vsi, addr); 2912 if (!f) 2913 ++mac2add_cnt; 2914 } 2915 2916 /* If this VF is not privileged, then we can't add more than a limited 2917 * number of addresses. Check to make sure that the additions do not 2918 * push us over the limit. 2919 */ 2920 if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 2921 if ((i40e_count_filters(vsi) + mac2add_cnt) > 2922 I40E_VC_MAX_MAC_ADDR_PER_VF) { 2923 dev_err(&pf->pdev->dev, 2924 "Cannot add more MAC addresses, VF is not trusted, switch the VF to trusted to add more functionality\n"); 2925 return -EPERM; 2926 } 2927 /* If this VF is trusted, it can use more resources than untrusted. 2928 * However to ensure that every trusted VF has appropriate number of 2929 * resources, divide whole pool of resources per port and then across 2930 * all VFs. 2931 */ 2932 } else { 2933 if ((i40e_count_filters(vsi) + mac2add_cnt) > 2934 I40E_VC_MAX_MACVLAN_PER_TRUSTED_VF(pf->num_alloc_vfs, 2935 hw->num_ports)) { 2936 dev_err(&pf->pdev->dev, 2937 "Cannot add more MAC addresses, trusted VF exhausted it's resources\n"); 2938 return -EPERM; 2939 } 2940 } 2941 return 0; 2942 } 2943 2944 /** 2945 * i40e_vc_ether_addr_type - get type of virtchnl_ether_addr 2946 * @vc_ether_addr: used to extract the type 2947 **/ 2948 static u8 2949 i40e_vc_ether_addr_type(struct virtchnl_ether_addr *vc_ether_addr) 2950 { 2951 return vc_ether_addr->type & VIRTCHNL_ETHER_ADDR_TYPE_MASK; 2952 } 2953 2954 /** 2955 * i40e_is_vc_addr_legacy 2956 * @vc_ether_addr: VIRTCHNL structure that contains MAC and type 2957 * 2958 * check if the MAC address is from an older VF 2959 **/ 2960 static bool 2961 i40e_is_vc_addr_legacy(struct virtchnl_ether_addr *vc_ether_addr) 2962 { 2963 return i40e_vc_ether_addr_type(vc_ether_addr) == 2964 VIRTCHNL_ETHER_ADDR_LEGACY; 2965 } 2966 2967 /** 2968 * i40e_is_vc_addr_primary 2969 * @vc_ether_addr: VIRTCHNL structure that contains MAC and type 2970 * 2971 * check if the MAC address is the VF's primary MAC 2972 * This function should only be called when the MAC address in 2973 * virtchnl_ether_addr is a valid unicast MAC 2974 **/ 2975 static bool 2976 i40e_is_vc_addr_primary(struct virtchnl_ether_addr *vc_ether_addr) 2977 { 2978 return i40e_vc_ether_addr_type(vc_ether_addr) == 2979 VIRTCHNL_ETHER_ADDR_PRIMARY; 2980 } 2981 2982 /** 2983 * i40e_update_vf_mac_addr 2984 * @vf: VF to update 2985 * @vc_ether_addr: structure from VIRTCHNL with MAC to add 2986 * 2987 * update the VF's cached hardware MAC if allowed 2988 **/ 2989 static void 2990 i40e_update_vf_mac_addr(struct i40e_vf *vf, 2991 struct virtchnl_ether_addr *vc_ether_addr) 2992 { 2993 u8 *mac_addr = vc_ether_addr->addr; 2994 2995 if (!is_valid_ether_addr(mac_addr)) 2996 return; 2997 2998 /* If request to add MAC filter is a primary request update its default 2999 * MAC address with the requested one. If it is a legacy request then 3000 * check if current default is empty if so update the default MAC 3001 */ 3002 if (i40e_is_vc_addr_primary(vc_ether_addr)) { 3003 ether_addr_copy(vf->default_lan_addr.addr, mac_addr); 3004 } else if (i40e_is_vc_addr_legacy(vc_ether_addr)) { 3005 if (is_zero_ether_addr(vf->default_lan_addr.addr)) 3006 ether_addr_copy(vf->default_lan_addr.addr, mac_addr); 3007 } 3008 } 3009 3010 /** 3011 * i40e_vc_add_mac_addr_msg 3012 * @vf: pointer to the VF info 3013 * @msg: pointer to the msg buffer 3014 * 3015 * add guest mac address filter 3016 **/ 3017 static int i40e_vc_add_mac_addr_msg(struct i40e_vf *vf, u8 *msg) 3018 { 3019 struct virtchnl_ether_addr_list *al = 3020 (struct virtchnl_ether_addr_list *)msg; 3021 struct i40e_pf *pf = vf->pf; 3022 struct i40e_vsi *vsi = NULL; 3023 int ret = 0; 3024 int i; 3025 3026 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE) || 3027 !i40e_vc_isvalid_vsi_id(vf, al->vsi_id)) { 3028 ret = -EINVAL; 3029 goto error_param; 3030 } 3031 3032 vsi = pf->vsi[vf->lan_vsi_idx]; 3033 3034 /* Lock once, because all function inside for loop accesses VSI's 3035 * MAC filter list which needs to be protected using same lock. 3036 */ 3037 spin_lock_bh(&vsi->mac_filter_hash_lock); 3038 3039 ret = i40e_check_vf_permission(vf, al); 3040 if (ret) { 3041 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3042 goto error_param; 3043 } 3044 3045 /* add new addresses to the list */ 3046 for (i = 0; i < al->num_elements; i++) { 3047 struct i40e_mac_filter *f; 3048 3049 f = i40e_find_mac(vsi, al->list[i].addr); 3050 if (!f) { 3051 f = i40e_add_mac_filter(vsi, al->list[i].addr); 3052 3053 if (!f) { 3054 dev_err(&pf->pdev->dev, 3055 "Unable to add MAC filter %pM for VF %d\n", 3056 al->list[i].addr, vf->vf_id); 3057 ret = -EINVAL; 3058 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3059 goto error_param; 3060 } 3061 } 3062 i40e_update_vf_mac_addr(vf, &al->list[i]); 3063 } 3064 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3065 3066 /* program the updated filter list */ 3067 ret = i40e_sync_vsi_filters(vsi); 3068 if (ret) 3069 dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n", 3070 vf->vf_id, ret); 3071 3072 error_param: 3073 /* send the response to the VF */ 3074 return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ADD_ETH_ADDR, 3075 ret, NULL, 0); 3076 } 3077 3078 /** 3079 * i40e_vc_del_mac_addr_msg 3080 * @vf: pointer to the VF info 3081 * @msg: pointer to the msg buffer 3082 * 3083 * remove guest mac address filter 3084 **/ 3085 static int i40e_vc_del_mac_addr_msg(struct i40e_vf *vf, u8 *msg) 3086 { 3087 struct virtchnl_ether_addr_list *al = 3088 (struct virtchnl_ether_addr_list *)msg; 3089 bool was_unimac_deleted = false; 3090 struct i40e_pf *pf = vf->pf; 3091 struct i40e_vsi *vsi = NULL; 3092 int ret = 0; 3093 int i; 3094 3095 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE) || 3096 !i40e_vc_isvalid_vsi_id(vf, al->vsi_id)) { 3097 ret = -EINVAL; 3098 goto error_param; 3099 } 3100 3101 for (i = 0; i < al->num_elements; i++) { 3102 if (is_broadcast_ether_addr(al->list[i].addr) || 3103 is_zero_ether_addr(al->list[i].addr)) { 3104 dev_err(&pf->pdev->dev, "Invalid MAC addr %pM for VF %d\n", 3105 al->list[i].addr, vf->vf_id); 3106 ret = -EINVAL; 3107 goto error_param; 3108 } 3109 if (ether_addr_equal(al->list[i].addr, vf->default_lan_addr.addr)) 3110 was_unimac_deleted = true; 3111 } 3112 vsi = pf->vsi[vf->lan_vsi_idx]; 3113 3114 spin_lock_bh(&vsi->mac_filter_hash_lock); 3115 /* delete addresses from the list */ 3116 for (i = 0; i < al->num_elements; i++) 3117 if (i40e_del_mac_filter(vsi, al->list[i].addr)) { 3118 ret = -EINVAL; 3119 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3120 goto error_param; 3121 } 3122 3123 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3124 3125 if (was_unimac_deleted) 3126 eth_zero_addr(vf->default_lan_addr.addr); 3127 3128 /* program the updated filter list */ 3129 ret = i40e_sync_vsi_filters(vsi); 3130 if (ret) 3131 dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n", 3132 vf->vf_id, ret); 3133 3134 if (vf->trusted && was_unimac_deleted) { 3135 struct i40e_mac_filter *f; 3136 struct hlist_node *h; 3137 u8 *macaddr = NULL; 3138 int bkt; 3139 3140 /* set last unicast mac address as default */ 3141 spin_lock_bh(&vsi->mac_filter_hash_lock); 3142 hash_for_each_safe(vsi->mac_filter_hash, bkt, h, f, hlist) { 3143 if (is_valid_ether_addr(f->macaddr)) 3144 macaddr = f->macaddr; 3145 } 3146 if (macaddr) 3147 ether_addr_copy(vf->default_lan_addr.addr, macaddr); 3148 spin_unlock_bh(&vsi->mac_filter_hash_lock); 3149 } 3150 error_param: 3151 /* send the response to the VF */ 3152 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_ETH_ADDR, ret); 3153 } 3154 3155 /** 3156 * i40e_vc_add_vlan_msg 3157 * @vf: pointer to the VF info 3158 * @msg: pointer to the msg buffer 3159 * 3160 * program guest vlan id 3161 **/ 3162 static int i40e_vc_add_vlan_msg(struct i40e_vf *vf, u8 *msg) 3163 { 3164 struct virtchnl_vlan_filter_list *vfl = 3165 (struct virtchnl_vlan_filter_list *)msg; 3166 struct i40e_pf *pf = vf->pf; 3167 struct i40e_vsi *vsi = NULL; 3168 int aq_ret = 0; 3169 int i; 3170 3171 if ((vf->num_vlan >= I40E_VC_MAX_VLAN_PER_VF) && 3172 !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 3173 dev_err(&pf->pdev->dev, 3174 "VF is not trusted, switch the VF to trusted to add more VLAN addresses\n"); 3175 goto error_param; 3176 } 3177 if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) || 3178 !i40e_vc_isvalid_vsi_id(vf, vfl->vsi_id)) { 3179 aq_ret = -EINVAL; 3180 goto error_param; 3181 } 3182 3183 for (i = 0; i < vfl->num_elements; i++) { 3184 if (vfl->vlan_id[i] > I40E_MAX_VLANID) { 3185 aq_ret = -EINVAL; 3186 dev_err(&pf->pdev->dev, 3187 "invalid VF VLAN id %d\n", vfl->vlan_id[i]); 3188 goto error_param; 3189 } 3190 } 3191 vsi = pf->vsi[vf->lan_vsi_idx]; 3192 if (vsi->info.pvid) { 3193 aq_ret = -EINVAL; 3194 goto error_param; 3195 } 3196 3197 i40e_vlan_stripping_enable(vsi); 3198 for (i = 0; i < vfl->num_elements; i++) { 3199 /* add new VLAN filter */ 3200 int ret = i40e_vsi_add_vlan(vsi, vfl->vlan_id[i]); 3201 if (!ret) 3202 vf->num_vlan++; 3203 3204 if (test_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states)) 3205 i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid, 3206 true, 3207 vfl->vlan_id[i], 3208 NULL); 3209 if (test_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states)) 3210 i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid, 3211 true, 3212 vfl->vlan_id[i], 3213 NULL); 3214 3215 if (ret) 3216 dev_err(&pf->pdev->dev, 3217 "Unable to add VLAN filter %d for VF %d, error %d\n", 3218 vfl->vlan_id[i], vf->vf_id, ret); 3219 } 3220 3221 error_param: 3222 /* send the response to the VF */ 3223 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ADD_VLAN, aq_ret); 3224 } 3225 3226 /** 3227 * i40e_vc_remove_vlan_msg 3228 * @vf: pointer to the VF info 3229 * @msg: pointer to the msg buffer 3230 * 3231 * remove programmed guest vlan id 3232 **/ 3233 static int i40e_vc_remove_vlan_msg(struct i40e_vf *vf, u8 *msg) 3234 { 3235 struct virtchnl_vlan_filter_list *vfl = 3236 (struct virtchnl_vlan_filter_list *)msg; 3237 struct i40e_pf *pf = vf->pf; 3238 struct i40e_vsi *vsi = NULL; 3239 int aq_ret = 0; 3240 int i; 3241 3242 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE) || 3243 !i40e_vc_isvalid_vsi_id(vf, vfl->vsi_id)) { 3244 aq_ret = -EINVAL; 3245 goto error_param; 3246 } 3247 3248 for (i = 0; i < vfl->num_elements; i++) { 3249 if (vfl->vlan_id[i] > I40E_MAX_VLANID) { 3250 aq_ret = -EINVAL; 3251 goto error_param; 3252 } 3253 } 3254 3255 vsi = pf->vsi[vf->lan_vsi_idx]; 3256 if (vsi->info.pvid) { 3257 if (vfl->num_elements > 1 || vfl->vlan_id[0]) 3258 aq_ret = -EINVAL; 3259 goto error_param; 3260 } 3261 3262 for (i = 0; i < vfl->num_elements; i++) { 3263 i40e_vsi_kill_vlan(vsi, vfl->vlan_id[i]); 3264 vf->num_vlan--; 3265 3266 if (test_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states)) 3267 i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid, 3268 false, 3269 vfl->vlan_id[i], 3270 NULL); 3271 if (test_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states)) 3272 i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid, 3273 false, 3274 vfl->vlan_id[i], 3275 NULL); 3276 } 3277 3278 error_param: 3279 /* send the response to the VF */ 3280 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_VLAN, aq_ret); 3281 } 3282 3283 /** 3284 * i40e_vc_rdma_msg 3285 * @vf: pointer to the VF info 3286 * @msg: pointer to the msg buffer 3287 * @msglen: msg length 3288 * 3289 * called from the VF for the iwarp msgs 3290 **/ 3291 static int i40e_vc_rdma_msg(struct i40e_vf *vf, u8 *msg, u16 msglen) 3292 { 3293 struct i40e_pf *pf = vf->pf; 3294 int abs_vf_id = vf->vf_id + pf->hw.func_caps.vf_base_id; 3295 int aq_ret = 0; 3296 3297 if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) || 3298 !test_bit(I40E_VF_STATE_RDMAENA, &vf->vf_states)) { 3299 aq_ret = -EINVAL; 3300 goto error_param; 3301 } 3302 3303 i40e_notify_client_of_vf_msg(pf->vsi[pf->lan_vsi], abs_vf_id, 3304 msg, msglen); 3305 3306 error_param: 3307 /* send the response to the VF */ 3308 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_RDMA, 3309 aq_ret); 3310 } 3311 3312 /** 3313 * i40e_vc_rdma_qvmap_msg 3314 * @vf: pointer to the VF info 3315 * @msg: pointer to the msg buffer 3316 * @config: config qvmap or release it 3317 * 3318 * called from the VF for the iwarp msgs 3319 **/ 3320 static int i40e_vc_rdma_qvmap_msg(struct i40e_vf *vf, u8 *msg, bool config) 3321 { 3322 struct virtchnl_rdma_qvlist_info *qvlist_info = 3323 (struct virtchnl_rdma_qvlist_info *)msg; 3324 int aq_ret = 0; 3325 3326 if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) || 3327 !test_bit(I40E_VF_STATE_RDMAENA, &vf->vf_states)) { 3328 aq_ret = -EINVAL; 3329 goto error_param; 3330 } 3331 3332 if (config) { 3333 if (i40e_config_rdma_qvlist(vf, qvlist_info)) 3334 aq_ret = -EINVAL; 3335 } else { 3336 i40e_release_rdma_qvlist(vf); 3337 } 3338 3339 error_param: 3340 /* send the response to the VF */ 3341 return i40e_vc_send_resp_to_vf(vf, 3342 config ? VIRTCHNL_OP_CONFIG_RDMA_IRQ_MAP : 3343 VIRTCHNL_OP_RELEASE_RDMA_IRQ_MAP, 3344 aq_ret); 3345 } 3346 3347 /** 3348 * i40e_vc_config_rss_key 3349 * @vf: pointer to the VF info 3350 * @msg: pointer to the msg buffer 3351 * 3352 * Configure the VF's RSS key 3353 **/ 3354 static int i40e_vc_config_rss_key(struct i40e_vf *vf, u8 *msg) 3355 { 3356 struct virtchnl_rss_key *vrk = 3357 (struct virtchnl_rss_key *)msg; 3358 struct i40e_pf *pf = vf->pf; 3359 struct i40e_vsi *vsi = NULL; 3360 int aq_ret = 0; 3361 3362 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE) || 3363 !i40e_vc_isvalid_vsi_id(vf, vrk->vsi_id) || 3364 vrk->key_len != I40E_HKEY_ARRAY_SIZE) { 3365 aq_ret = -EINVAL; 3366 goto err; 3367 } 3368 3369 vsi = pf->vsi[vf->lan_vsi_idx]; 3370 aq_ret = i40e_config_rss(vsi, vrk->key, NULL, 0); 3371 err: 3372 /* send the response to the VF */ 3373 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_KEY, 3374 aq_ret); 3375 } 3376 3377 /** 3378 * i40e_vc_config_rss_lut 3379 * @vf: pointer to the VF info 3380 * @msg: pointer to the msg buffer 3381 * 3382 * Configure the VF's RSS LUT 3383 **/ 3384 static int i40e_vc_config_rss_lut(struct i40e_vf *vf, u8 *msg) 3385 { 3386 struct virtchnl_rss_lut *vrl = 3387 (struct virtchnl_rss_lut *)msg; 3388 struct i40e_pf *pf = vf->pf; 3389 struct i40e_vsi *vsi = NULL; 3390 int aq_ret = 0; 3391 u16 i; 3392 3393 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE) || 3394 !i40e_vc_isvalid_vsi_id(vf, vrl->vsi_id) || 3395 vrl->lut_entries != I40E_VF_HLUT_ARRAY_SIZE) { 3396 aq_ret = -EINVAL; 3397 goto err; 3398 } 3399 3400 for (i = 0; i < vrl->lut_entries; i++) 3401 if (vrl->lut[i] >= vf->num_queue_pairs) { 3402 aq_ret = -EINVAL; 3403 goto err; 3404 } 3405 3406 vsi = pf->vsi[vf->lan_vsi_idx]; 3407 aq_ret = i40e_config_rss(vsi, NULL, vrl->lut, I40E_VF_HLUT_ARRAY_SIZE); 3408 /* send the response to the VF */ 3409 err: 3410 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_LUT, 3411 aq_ret); 3412 } 3413 3414 /** 3415 * i40e_vc_get_rss_hena 3416 * @vf: pointer to the VF info 3417 * @msg: pointer to the msg buffer 3418 * 3419 * Return the RSS HENA bits allowed by the hardware 3420 **/ 3421 static int i40e_vc_get_rss_hena(struct i40e_vf *vf, u8 *msg) 3422 { 3423 struct virtchnl_rss_hena *vrh = NULL; 3424 struct i40e_pf *pf = vf->pf; 3425 int aq_ret = 0; 3426 int len = 0; 3427 3428 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3429 aq_ret = -EINVAL; 3430 goto err; 3431 } 3432 len = sizeof(struct virtchnl_rss_hena); 3433 3434 vrh = kzalloc(len, GFP_KERNEL); 3435 if (!vrh) { 3436 aq_ret = -ENOMEM; 3437 len = 0; 3438 goto err; 3439 } 3440 vrh->hena = i40e_pf_get_default_rss_hena(pf); 3441 err: 3442 /* send the response back to the VF */ 3443 aq_ret = i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_RSS_HENA_CAPS, 3444 aq_ret, (u8 *)vrh, len); 3445 kfree(vrh); 3446 return aq_ret; 3447 } 3448 3449 /** 3450 * i40e_vc_set_rss_hena 3451 * @vf: pointer to the VF info 3452 * @msg: pointer to the msg buffer 3453 * 3454 * Set the RSS HENA bits for the VF 3455 **/ 3456 static int i40e_vc_set_rss_hena(struct i40e_vf *vf, u8 *msg) 3457 { 3458 struct virtchnl_rss_hena *vrh = 3459 (struct virtchnl_rss_hena *)msg; 3460 struct i40e_pf *pf = vf->pf; 3461 struct i40e_hw *hw = &pf->hw; 3462 int aq_ret = 0; 3463 3464 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3465 aq_ret = -EINVAL; 3466 goto err; 3467 } 3468 i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(0, vf->vf_id), (u32)vrh->hena); 3469 i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(1, vf->vf_id), 3470 (u32)(vrh->hena >> 32)); 3471 3472 /* send the response to the VF */ 3473 err: 3474 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_SET_RSS_HENA, aq_ret); 3475 } 3476 3477 /** 3478 * i40e_vc_enable_vlan_stripping 3479 * @vf: pointer to the VF info 3480 * @msg: pointer to the msg buffer 3481 * 3482 * Enable vlan header stripping for the VF 3483 **/ 3484 static int i40e_vc_enable_vlan_stripping(struct i40e_vf *vf, u8 *msg) 3485 { 3486 struct i40e_vsi *vsi; 3487 int aq_ret = 0; 3488 3489 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3490 aq_ret = -EINVAL; 3491 goto err; 3492 } 3493 3494 vsi = vf->pf->vsi[vf->lan_vsi_idx]; 3495 i40e_vlan_stripping_enable(vsi); 3496 3497 /* send the response to the VF */ 3498 err: 3499 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING, 3500 aq_ret); 3501 } 3502 3503 /** 3504 * i40e_vc_disable_vlan_stripping 3505 * @vf: pointer to the VF info 3506 * @msg: pointer to the msg buffer 3507 * 3508 * Disable vlan header stripping for the VF 3509 **/ 3510 static int i40e_vc_disable_vlan_stripping(struct i40e_vf *vf, u8 *msg) 3511 { 3512 struct i40e_vsi *vsi; 3513 int aq_ret = 0; 3514 3515 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3516 aq_ret = -EINVAL; 3517 goto err; 3518 } 3519 3520 vsi = vf->pf->vsi[vf->lan_vsi_idx]; 3521 i40e_vlan_stripping_disable(vsi); 3522 3523 /* send the response to the VF */ 3524 err: 3525 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING, 3526 aq_ret); 3527 } 3528 3529 /** 3530 * i40e_validate_cloud_filter 3531 * @vf: pointer to VF structure 3532 * @tc_filter: pointer to filter requested 3533 * 3534 * This function validates cloud filter programmed as TC filter for ADq 3535 **/ 3536 static int i40e_validate_cloud_filter(struct i40e_vf *vf, 3537 struct virtchnl_filter *tc_filter) 3538 { 3539 struct virtchnl_l4_spec mask = tc_filter->mask.tcp_spec; 3540 struct virtchnl_l4_spec data = tc_filter->data.tcp_spec; 3541 struct i40e_pf *pf = vf->pf; 3542 struct i40e_vsi *vsi = NULL; 3543 struct i40e_mac_filter *f; 3544 struct hlist_node *h; 3545 bool found = false; 3546 int bkt; 3547 3548 if (tc_filter->action != VIRTCHNL_ACTION_TC_REDIRECT) { 3549 dev_info(&pf->pdev->dev, 3550 "VF %d: ADQ doesn't support this action (%d)\n", 3551 vf->vf_id, tc_filter->action); 3552 goto err; 3553 } 3554 3555 /* action_meta is TC number here to which the filter is applied */ 3556 if (!tc_filter->action_meta || 3557 tc_filter->action_meta > vf->num_tc) { 3558 dev_info(&pf->pdev->dev, "VF %d: Invalid TC number %u\n", 3559 vf->vf_id, tc_filter->action_meta); 3560 goto err; 3561 } 3562 3563 /* Check filter if it's programmed for advanced mode or basic mode. 3564 * There are two ADq modes (for VF only), 3565 * 1. Basic mode: intended to allow as many filter options as possible 3566 * to be added to a VF in Non-trusted mode. Main goal is 3567 * to add filters to its own MAC and VLAN id. 3568 * 2. Advanced mode: is for allowing filters to be applied other than 3569 * its own MAC or VLAN. This mode requires the VF to be 3570 * Trusted. 3571 */ 3572 if (mask.dst_mac[0] && !mask.dst_ip[0]) { 3573 vsi = pf->vsi[vf->lan_vsi_idx]; 3574 f = i40e_find_mac(vsi, data.dst_mac); 3575 3576 if (!f) { 3577 dev_info(&pf->pdev->dev, 3578 "Destination MAC %pM doesn't belong to VF %d\n", 3579 data.dst_mac, vf->vf_id); 3580 goto err; 3581 } 3582 3583 if (mask.vlan_id) { 3584 hash_for_each_safe(vsi->mac_filter_hash, bkt, h, f, 3585 hlist) { 3586 if (f->vlan == ntohs(data.vlan_id)) { 3587 found = true; 3588 break; 3589 } 3590 } 3591 if (!found) { 3592 dev_info(&pf->pdev->dev, 3593 "VF %d doesn't have any VLAN id %u\n", 3594 vf->vf_id, ntohs(data.vlan_id)); 3595 goto err; 3596 } 3597 } 3598 } else { 3599 /* Check if VF is trusted */ 3600 if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) { 3601 dev_err(&pf->pdev->dev, 3602 "VF %d not trusted, make VF trusted to add advanced mode ADq cloud filters\n", 3603 vf->vf_id); 3604 return -EIO; 3605 } 3606 } 3607 3608 if (mask.dst_mac[0] & data.dst_mac[0]) { 3609 if (is_broadcast_ether_addr(data.dst_mac) || 3610 is_zero_ether_addr(data.dst_mac)) { 3611 dev_info(&pf->pdev->dev, "VF %d: Invalid Dest MAC addr %pM\n", 3612 vf->vf_id, data.dst_mac); 3613 goto err; 3614 } 3615 } 3616 3617 if (mask.src_mac[0] & data.src_mac[0]) { 3618 if (is_broadcast_ether_addr(data.src_mac) || 3619 is_zero_ether_addr(data.src_mac)) { 3620 dev_info(&pf->pdev->dev, "VF %d: Invalid Source MAC addr %pM\n", 3621 vf->vf_id, data.src_mac); 3622 goto err; 3623 } 3624 } 3625 3626 if (mask.dst_port & data.dst_port) { 3627 if (!data.dst_port) { 3628 dev_info(&pf->pdev->dev, "VF %d: Invalid Dest port\n", 3629 vf->vf_id); 3630 goto err; 3631 } 3632 } 3633 3634 if (mask.src_port & data.src_port) { 3635 if (!data.src_port) { 3636 dev_info(&pf->pdev->dev, "VF %d: Invalid Source port\n", 3637 vf->vf_id); 3638 goto err; 3639 } 3640 } 3641 3642 if (tc_filter->flow_type != VIRTCHNL_TCP_V6_FLOW && 3643 tc_filter->flow_type != VIRTCHNL_TCP_V4_FLOW) { 3644 dev_info(&pf->pdev->dev, "VF %d: Invalid Flow type\n", 3645 vf->vf_id); 3646 goto err; 3647 } 3648 3649 if (mask.vlan_id & data.vlan_id) { 3650 if (ntohs(data.vlan_id) > I40E_MAX_VLANID) { 3651 dev_info(&pf->pdev->dev, "VF %d: invalid VLAN ID\n", 3652 vf->vf_id); 3653 goto err; 3654 } 3655 } 3656 3657 return 0; 3658 err: 3659 return -EIO; 3660 } 3661 3662 /** 3663 * i40e_find_vsi_from_seid - searches for the vsi with the given seid 3664 * @vf: pointer to the VF info 3665 * @seid: seid of the vsi it is searching for 3666 **/ 3667 static struct i40e_vsi *i40e_find_vsi_from_seid(struct i40e_vf *vf, u16 seid) 3668 { 3669 struct i40e_pf *pf = vf->pf; 3670 struct i40e_vsi *vsi = NULL; 3671 int i; 3672 3673 for (i = 0; i < vf->num_tc ; i++) { 3674 vsi = i40e_find_vsi_from_id(pf, vf->ch[i].vsi_id); 3675 if (vsi && vsi->seid == seid) 3676 return vsi; 3677 } 3678 return NULL; 3679 } 3680 3681 /** 3682 * i40e_del_all_cloud_filters 3683 * @vf: pointer to the VF info 3684 * 3685 * This function deletes all cloud filters 3686 **/ 3687 static void i40e_del_all_cloud_filters(struct i40e_vf *vf) 3688 { 3689 struct i40e_cloud_filter *cfilter = NULL; 3690 struct i40e_pf *pf = vf->pf; 3691 struct i40e_vsi *vsi = NULL; 3692 struct hlist_node *node; 3693 int ret; 3694 3695 hlist_for_each_entry_safe(cfilter, node, 3696 &vf->cloud_filter_list, cloud_node) { 3697 vsi = i40e_find_vsi_from_seid(vf, cfilter->seid); 3698 3699 if (!vsi) { 3700 dev_err(&pf->pdev->dev, "VF %d: no VSI found for matching %u seid, can't delete cloud filter\n", 3701 vf->vf_id, cfilter->seid); 3702 continue; 3703 } 3704 3705 if (cfilter->dst_port) 3706 ret = i40e_add_del_cloud_filter_big_buf(vsi, cfilter, 3707 false); 3708 else 3709 ret = i40e_add_del_cloud_filter(vsi, cfilter, false); 3710 if (ret) 3711 dev_err(&pf->pdev->dev, 3712 "VF %d: Failed to delete cloud filter, err %pe aq_err %s\n", 3713 vf->vf_id, ERR_PTR(ret), 3714 i40e_aq_str(&pf->hw, 3715 pf->hw.aq.asq_last_status)); 3716 3717 hlist_del(&cfilter->cloud_node); 3718 kfree(cfilter); 3719 vf->num_cloud_filters--; 3720 } 3721 } 3722 3723 /** 3724 * i40e_vc_del_cloud_filter 3725 * @vf: pointer to the VF info 3726 * @msg: pointer to the msg buffer 3727 * 3728 * This function deletes a cloud filter programmed as TC filter for ADq 3729 **/ 3730 static int i40e_vc_del_cloud_filter(struct i40e_vf *vf, u8 *msg) 3731 { 3732 struct virtchnl_filter *vcf = (struct virtchnl_filter *)msg; 3733 struct virtchnl_l4_spec mask = vcf->mask.tcp_spec; 3734 struct virtchnl_l4_spec tcf = vcf->data.tcp_spec; 3735 struct i40e_cloud_filter cfilter, *cf = NULL; 3736 struct i40e_pf *pf = vf->pf; 3737 struct i40e_vsi *vsi = NULL; 3738 struct hlist_node *node; 3739 int aq_ret = 0; 3740 int i, ret; 3741 3742 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3743 aq_ret = -EINVAL; 3744 goto err; 3745 } 3746 3747 if (!vf->adq_enabled) { 3748 dev_info(&pf->pdev->dev, 3749 "VF %d: ADq not enabled, can't apply cloud filter\n", 3750 vf->vf_id); 3751 aq_ret = -EINVAL; 3752 goto err; 3753 } 3754 3755 if (i40e_validate_cloud_filter(vf, vcf)) { 3756 dev_info(&pf->pdev->dev, 3757 "VF %d: Invalid input, can't apply cloud filter\n", 3758 vf->vf_id); 3759 aq_ret = -EINVAL; 3760 goto err; 3761 } 3762 3763 memset(&cfilter, 0, sizeof(cfilter)); 3764 /* parse destination mac address */ 3765 for (i = 0; i < ETH_ALEN; i++) 3766 cfilter.dst_mac[i] = mask.dst_mac[i] & tcf.dst_mac[i]; 3767 3768 /* parse source mac address */ 3769 for (i = 0; i < ETH_ALEN; i++) 3770 cfilter.src_mac[i] = mask.src_mac[i] & tcf.src_mac[i]; 3771 3772 cfilter.vlan_id = mask.vlan_id & tcf.vlan_id; 3773 cfilter.dst_port = mask.dst_port & tcf.dst_port; 3774 cfilter.src_port = mask.src_port & tcf.src_port; 3775 3776 switch (vcf->flow_type) { 3777 case VIRTCHNL_TCP_V4_FLOW: 3778 cfilter.n_proto = ETH_P_IP; 3779 if (mask.dst_ip[0] & tcf.dst_ip[0]) 3780 memcpy(&cfilter.ip.v4.dst_ip, tcf.dst_ip, 3781 ARRAY_SIZE(tcf.dst_ip)); 3782 else if (mask.src_ip[0] & tcf.dst_ip[0]) 3783 memcpy(&cfilter.ip.v4.src_ip, tcf.src_ip, 3784 ARRAY_SIZE(tcf.dst_ip)); 3785 break; 3786 case VIRTCHNL_TCP_V6_FLOW: 3787 cfilter.n_proto = ETH_P_IPV6; 3788 if (mask.dst_ip[3] & tcf.dst_ip[3]) 3789 memcpy(&cfilter.ip.v6.dst_ip6, tcf.dst_ip, 3790 sizeof(cfilter.ip.v6.dst_ip6)); 3791 if (mask.src_ip[3] & tcf.src_ip[3]) 3792 memcpy(&cfilter.ip.v6.src_ip6, tcf.src_ip, 3793 sizeof(cfilter.ip.v6.src_ip6)); 3794 break; 3795 default: 3796 /* TC filter can be configured based on different combinations 3797 * and in this case IP is not a part of filter config 3798 */ 3799 dev_info(&pf->pdev->dev, "VF %d: Flow type not configured\n", 3800 vf->vf_id); 3801 } 3802 3803 /* get the vsi to which the tc belongs to */ 3804 vsi = pf->vsi[vf->ch[vcf->action_meta].vsi_idx]; 3805 cfilter.seid = vsi->seid; 3806 cfilter.flags = vcf->field_flags; 3807 3808 /* Deleting TC filter */ 3809 if (tcf.dst_port) 3810 ret = i40e_add_del_cloud_filter_big_buf(vsi, &cfilter, false); 3811 else 3812 ret = i40e_add_del_cloud_filter(vsi, &cfilter, false); 3813 if (ret) { 3814 dev_err(&pf->pdev->dev, 3815 "VF %d: Failed to delete cloud filter, err %pe aq_err %s\n", 3816 vf->vf_id, ERR_PTR(ret), 3817 i40e_aq_str(&pf->hw, pf->hw.aq.asq_last_status)); 3818 goto err; 3819 } 3820 3821 hlist_for_each_entry_safe(cf, node, 3822 &vf->cloud_filter_list, cloud_node) { 3823 if (cf->seid != cfilter.seid) 3824 continue; 3825 if (mask.dst_port) 3826 if (cfilter.dst_port != cf->dst_port) 3827 continue; 3828 if (mask.dst_mac[0]) 3829 if (!ether_addr_equal(cf->src_mac, cfilter.src_mac)) 3830 continue; 3831 /* for ipv4 data to be valid, only first byte of mask is set */ 3832 if (cfilter.n_proto == ETH_P_IP && mask.dst_ip[0]) 3833 if (memcmp(&cfilter.ip.v4.dst_ip, &cf->ip.v4.dst_ip, 3834 ARRAY_SIZE(tcf.dst_ip))) 3835 continue; 3836 /* for ipv6, mask is set for all sixteen bytes (4 words) */ 3837 if (cfilter.n_proto == ETH_P_IPV6 && mask.dst_ip[3]) 3838 if (memcmp(&cfilter.ip.v6.dst_ip6, &cf->ip.v6.dst_ip6, 3839 sizeof(cfilter.ip.v6.src_ip6))) 3840 continue; 3841 if (mask.vlan_id) 3842 if (cfilter.vlan_id != cf->vlan_id) 3843 continue; 3844 3845 hlist_del(&cf->cloud_node); 3846 kfree(cf); 3847 vf->num_cloud_filters--; 3848 } 3849 3850 err: 3851 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_CLOUD_FILTER, 3852 aq_ret); 3853 } 3854 3855 /** 3856 * i40e_vc_add_cloud_filter 3857 * @vf: pointer to the VF info 3858 * @msg: pointer to the msg buffer 3859 * 3860 * This function adds a cloud filter programmed as TC filter for ADq 3861 **/ 3862 static int i40e_vc_add_cloud_filter(struct i40e_vf *vf, u8 *msg) 3863 { 3864 struct virtchnl_filter *vcf = (struct virtchnl_filter *)msg; 3865 struct virtchnl_l4_spec mask = vcf->mask.tcp_spec; 3866 struct virtchnl_l4_spec tcf = vcf->data.tcp_spec; 3867 struct i40e_cloud_filter *cfilter = NULL; 3868 struct i40e_pf *pf = vf->pf; 3869 struct i40e_vsi *vsi = NULL; 3870 int aq_ret = 0; 3871 int i; 3872 3873 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3874 aq_ret = -EINVAL; 3875 goto err_out; 3876 } 3877 3878 if (!vf->adq_enabled) { 3879 dev_info(&pf->pdev->dev, 3880 "VF %d: ADq is not enabled, can't apply cloud filter\n", 3881 vf->vf_id); 3882 aq_ret = -EINVAL; 3883 goto err_out; 3884 } 3885 3886 if (i40e_validate_cloud_filter(vf, vcf)) { 3887 dev_info(&pf->pdev->dev, 3888 "VF %d: Invalid input/s, can't apply cloud filter\n", 3889 vf->vf_id); 3890 aq_ret = -EINVAL; 3891 goto err_out; 3892 } 3893 3894 cfilter = kzalloc(sizeof(*cfilter), GFP_KERNEL); 3895 if (!cfilter) { 3896 aq_ret = -ENOMEM; 3897 goto err_out; 3898 } 3899 3900 /* parse destination mac address */ 3901 for (i = 0; i < ETH_ALEN; i++) 3902 cfilter->dst_mac[i] = mask.dst_mac[i] & tcf.dst_mac[i]; 3903 3904 /* parse source mac address */ 3905 for (i = 0; i < ETH_ALEN; i++) 3906 cfilter->src_mac[i] = mask.src_mac[i] & tcf.src_mac[i]; 3907 3908 cfilter->vlan_id = mask.vlan_id & tcf.vlan_id; 3909 cfilter->dst_port = mask.dst_port & tcf.dst_port; 3910 cfilter->src_port = mask.src_port & tcf.src_port; 3911 3912 switch (vcf->flow_type) { 3913 case VIRTCHNL_TCP_V4_FLOW: 3914 cfilter->n_proto = ETH_P_IP; 3915 if (mask.dst_ip[0] & tcf.dst_ip[0]) 3916 memcpy(&cfilter->ip.v4.dst_ip, tcf.dst_ip, 3917 ARRAY_SIZE(tcf.dst_ip)); 3918 else if (mask.src_ip[0] & tcf.dst_ip[0]) 3919 memcpy(&cfilter->ip.v4.src_ip, tcf.src_ip, 3920 ARRAY_SIZE(tcf.dst_ip)); 3921 break; 3922 case VIRTCHNL_TCP_V6_FLOW: 3923 cfilter->n_proto = ETH_P_IPV6; 3924 if (mask.dst_ip[3] & tcf.dst_ip[3]) 3925 memcpy(&cfilter->ip.v6.dst_ip6, tcf.dst_ip, 3926 sizeof(cfilter->ip.v6.dst_ip6)); 3927 if (mask.src_ip[3] & tcf.src_ip[3]) 3928 memcpy(&cfilter->ip.v6.src_ip6, tcf.src_ip, 3929 sizeof(cfilter->ip.v6.src_ip6)); 3930 break; 3931 default: 3932 /* TC filter can be configured based on different combinations 3933 * and in this case IP is not a part of filter config 3934 */ 3935 dev_info(&pf->pdev->dev, "VF %d: Flow type not configured\n", 3936 vf->vf_id); 3937 } 3938 3939 /* get the VSI to which the TC belongs to */ 3940 vsi = pf->vsi[vf->ch[vcf->action_meta].vsi_idx]; 3941 cfilter->seid = vsi->seid; 3942 cfilter->flags = vcf->field_flags; 3943 3944 /* Adding cloud filter programmed as TC filter */ 3945 if (tcf.dst_port) 3946 aq_ret = i40e_add_del_cloud_filter_big_buf(vsi, cfilter, true); 3947 else 3948 aq_ret = i40e_add_del_cloud_filter(vsi, cfilter, true); 3949 if (aq_ret) { 3950 dev_err(&pf->pdev->dev, 3951 "VF %d: Failed to add cloud filter, err %pe aq_err %s\n", 3952 vf->vf_id, ERR_PTR(aq_ret), 3953 i40e_aq_str(&pf->hw, pf->hw.aq.asq_last_status)); 3954 goto err_free; 3955 } 3956 3957 INIT_HLIST_NODE(&cfilter->cloud_node); 3958 hlist_add_head(&cfilter->cloud_node, &vf->cloud_filter_list); 3959 /* release the pointer passing it to the collection */ 3960 cfilter = NULL; 3961 vf->num_cloud_filters++; 3962 err_free: 3963 kfree(cfilter); 3964 err_out: 3965 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ADD_CLOUD_FILTER, 3966 aq_ret); 3967 } 3968 3969 /** 3970 * i40e_vc_add_qch_msg: Add queue channel and enable ADq 3971 * @vf: pointer to the VF info 3972 * @msg: pointer to the msg buffer 3973 **/ 3974 static int i40e_vc_add_qch_msg(struct i40e_vf *vf, u8 *msg) 3975 { 3976 struct virtchnl_tc_info *tci = 3977 (struct virtchnl_tc_info *)msg; 3978 struct i40e_pf *pf = vf->pf; 3979 struct i40e_link_status *ls = &pf->hw.phy.link_info; 3980 int i, adq_request_qps = 0; 3981 int aq_ret = 0; 3982 u64 speed = 0; 3983 3984 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 3985 aq_ret = -EINVAL; 3986 goto err; 3987 } 3988 3989 /* ADq cannot be applied if spoof check is ON */ 3990 if (vf->spoofchk) { 3991 dev_err(&pf->pdev->dev, 3992 "Spoof check is ON, turn it OFF to enable ADq\n"); 3993 aq_ret = -EINVAL; 3994 goto err; 3995 } 3996 3997 if (!(vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ADQ)) { 3998 dev_err(&pf->pdev->dev, 3999 "VF %d attempting to enable ADq, but hasn't properly negotiated that capability\n", 4000 vf->vf_id); 4001 aq_ret = -EINVAL; 4002 goto err; 4003 } 4004 4005 /* max number of traffic classes for VF currently capped at 4 */ 4006 if (!tci->num_tc || tci->num_tc > I40E_MAX_VF_VSI) { 4007 dev_err(&pf->pdev->dev, 4008 "VF %d trying to set %u TCs, valid range 1-%u TCs per VF\n", 4009 vf->vf_id, tci->num_tc, I40E_MAX_VF_VSI); 4010 aq_ret = -EINVAL; 4011 goto err; 4012 } 4013 4014 /* validate queues for each TC */ 4015 for (i = 0; i < tci->num_tc; i++) 4016 if (!tci->list[i].count || 4017 tci->list[i].count > I40E_DEFAULT_QUEUES_PER_VF) { 4018 dev_err(&pf->pdev->dev, 4019 "VF %d: TC %d trying to set %u queues, valid range 1-%u queues per TC\n", 4020 vf->vf_id, i, tci->list[i].count, 4021 I40E_DEFAULT_QUEUES_PER_VF); 4022 aq_ret = -EINVAL; 4023 goto err; 4024 } 4025 4026 /* need Max VF queues but already have default number of queues */ 4027 adq_request_qps = I40E_MAX_VF_QUEUES - I40E_DEFAULT_QUEUES_PER_VF; 4028 4029 if (pf->queues_left < adq_request_qps) { 4030 dev_err(&pf->pdev->dev, 4031 "No queues left to allocate to VF %d\n", 4032 vf->vf_id); 4033 aq_ret = -EINVAL; 4034 goto err; 4035 } else { 4036 /* we need to allocate max VF queues to enable ADq so as to 4037 * make sure ADq enabled VF always gets back queues when it 4038 * goes through a reset. 4039 */ 4040 vf->num_queue_pairs = I40E_MAX_VF_QUEUES; 4041 } 4042 4043 /* get link speed in MB to validate rate limit */ 4044 speed = i40e_vc_link_speed2mbps(ls->link_speed); 4045 if (speed == SPEED_UNKNOWN) { 4046 dev_err(&pf->pdev->dev, 4047 "Cannot detect link speed\n"); 4048 aq_ret = -EINVAL; 4049 goto err; 4050 } 4051 4052 /* parse data from the queue channel info */ 4053 vf->num_tc = tci->num_tc; 4054 for (i = 0; i < vf->num_tc; i++) { 4055 if (tci->list[i].max_tx_rate) { 4056 if (tci->list[i].max_tx_rate > speed) { 4057 dev_err(&pf->pdev->dev, 4058 "Invalid max tx rate %llu specified for VF %d.", 4059 tci->list[i].max_tx_rate, 4060 vf->vf_id); 4061 aq_ret = -EINVAL; 4062 goto err; 4063 } else { 4064 vf->ch[i].max_tx_rate = 4065 tci->list[i].max_tx_rate; 4066 } 4067 } 4068 vf->ch[i].num_qps = tci->list[i].count; 4069 } 4070 4071 /* set this flag only after making sure all inputs are sane */ 4072 vf->adq_enabled = true; 4073 4074 /* reset the VF in order to allocate resources */ 4075 i40e_vc_reset_vf(vf, true); 4076 4077 return 0; 4078 4079 /* send the response to the VF */ 4080 err: 4081 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_CHANNELS, 4082 aq_ret); 4083 } 4084 4085 /** 4086 * i40e_vc_del_qch_msg 4087 * @vf: pointer to the VF info 4088 * @msg: pointer to the msg buffer 4089 **/ 4090 static int i40e_vc_del_qch_msg(struct i40e_vf *vf, u8 *msg) 4091 { 4092 struct i40e_pf *pf = vf->pf; 4093 int aq_ret = 0; 4094 4095 if (!i40e_sync_vf_state(vf, I40E_VF_STATE_ACTIVE)) { 4096 aq_ret = -EINVAL; 4097 goto err; 4098 } 4099 4100 if (vf->adq_enabled) { 4101 i40e_del_all_cloud_filters(vf); 4102 i40e_del_qch(vf); 4103 vf->adq_enabled = false; 4104 vf->num_tc = 0; 4105 dev_info(&pf->pdev->dev, 4106 "Deleting Queue Channels and cloud filters for ADq on VF %d\n", 4107 vf->vf_id); 4108 } else { 4109 dev_info(&pf->pdev->dev, "VF %d trying to delete queue channels but ADq isn't enabled\n", 4110 vf->vf_id); 4111 aq_ret = -EINVAL; 4112 } 4113 4114 /* reset the VF in order to allocate resources */ 4115 i40e_vc_reset_vf(vf, true); 4116 4117 return 0; 4118 4119 err: 4120 return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_CHANNELS, 4121 aq_ret); 4122 } 4123 4124 /** 4125 * i40e_vc_process_vf_msg 4126 * @pf: pointer to the PF structure 4127 * @vf_id: source VF id 4128 * @v_opcode: operation code 4129 * @v_retval: unused return value code 4130 * @msg: pointer to the msg buffer 4131 * @msglen: msg length 4132 * 4133 * called from the common aeq/arq handler to 4134 * process request from VF 4135 **/ 4136 int i40e_vc_process_vf_msg(struct i40e_pf *pf, s16 vf_id, u32 v_opcode, 4137 u32 __always_unused v_retval, u8 *msg, u16 msglen) 4138 { 4139 struct i40e_hw *hw = &pf->hw; 4140 int local_vf_id = vf_id - (s16)hw->func_caps.vf_base_id; 4141 struct i40e_vf *vf; 4142 int ret; 4143 4144 pf->vf_aq_requests++; 4145 if (local_vf_id < 0 || local_vf_id >= pf->num_alloc_vfs) 4146 return -EINVAL; 4147 vf = &(pf->vf[local_vf_id]); 4148 4149 /* Check if VF is disabled. */ 4150 if (test_bit(I40E_VF_STATE_DISABLED, &vf->vf_states)) 4151 return -EINVAL; 4152 4153 /* perform basic checks on the msg */ 4154 ret = virtchnl_vc_validate_vf_msg(&vf->vf_ver, v_opcode, msg, msglen); 4155 4156 if (ret) { 4157 i40e_vc_send_resp_to_vf(vf, v_opcode, -EINVAL); 4158 dev_err(&pf->pdev->dev, "Invalid message from VF %d, opcode %d, len %d\n", 4159 local_vf_id, v_opcode, msglen); 4160 return ret; 4161 } 4162 4163 switch (v_opcode) { 4164 case VIRTCHNL_OP_VERSION: 4165 ret = i40e_vc_get_version_msg(vf, msg); 4166 break; 4167 case VIRTCHNL_OP_GET_VF_RESOURCES: 4168 ret = i40e_vc_get_vf_resources_msg(vf, msg); 4169 i40e_vc_notify_vf_link_state(vf); 4170 break; 4171 case VIRTCHNL_OP_RESET_VF: 4172 i40e_vc_reset_vf(vf, false); 4173 ret = 0; 4174 break; 4175 case VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE: 4176 ret = i40e_vc_config_promiscuous_mode_msg(vf, msg); 4177 break; 4178 case VIRTCHNL_OP_CONFIG_VSI_QUEUES: 4179 ret = i40e_vc_config_queues_msg(vf, msg); 4180 break; 4181 case VIRTCHNL_OP_CONFIG_IRQ_MAP: 4182 ret = i40e_vc_config_irq_map_msg(vf, msg); 4183 break; 4184 case VIRTCHNL_OP_ENABLE_QUEUES: 4185 ret = i40e_vc_enable_queues_msg(vf, msg); 4186 i40e_vc_notify_vf_link_state(vf); 4187 break; 4188 case VIRTCHNL_OP_DISABLE_QUEUES: 4189 ret = i40e_vc_disable_queues_msg(vf, msg); 4190 break; 4191 case VIRTCHNL_OP_ADD_ETH_ADDR: 4192 ret = i40e_vc_add_mac_addr_msg(vf, msg); 4193 break; 4194 case VIRTCHNL_OP_DEL_ETH_ADDR: 4195 ret = i40e_vc_del_mac_addr_msg(vf, msg); 4196 break; 4197 case VIRTCHNL_OP_ADD_VLAN: 4198 ret = i40e_vc_add_vlan_msg(vf, msg); 4199 break; 4200 case VIRTCHNL_OP_DEL_VLAN: 4201 ret = i40e_vc_remove_vlan_msg(vf, msg); 4202 break; 4203 case VIRTCHNL_OP_GET_STATS: 4204 ret = i40e_vc_get_stats_msg(vf, msg); 4205 break; 4206 case VIRTCHNL_OP_RDMA: 4207 ret = i40e_vc_rdma_msg(vf, msg, msglen); 4208 break; 4209 case VIRTCHNL_OP_CONFIG_RDMA_IRQ_MAP: 4210 ret = i40e_vc_rdma_qvmap_msg(vf, msg, true); 4211 break; 4212 case VIRTCHNL_OP_RELEASE_RDMA_IRQ_MAP: 4213 ret = i40e_vc_rdma_qvmap_msg(vf, msg, false); 4214 break; 4215 case VIRTCHNL_OP_CONFIG_RSS_KEY: 4216 ret = i40e_vc_config_rss_key(vf, msg); 4217 break; 4218 case VIRTCHNL_OP_CONFIG_RSS_LUT: 4219 ret = i40e_vc_config_rss_lut(vf, msg); 4220 break; 4221 case VIRTCHNL_OP_GET_RSS_HENA_CAPS: 4222 ret = i40e_vc_get_rss_hena(vf, msg); 4223 break; 4224 case VIRTCHNL_OP_SET_RSS_HENA: 4225 ret = i40e_vc_set_rss_hena(vf, msg); 4226 break; 4227 case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING: 4228 ret = i40e_vc_enable_vlan_stripping(vf, msg); 4229 break; 4230 case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING: 4231 ret = i40e_vc_disable_vlan_stripping(vf, msg); 4232 break; 4233 case VIRTCHNL_OP_REQUEST_QUEUES: 4234 ret = i40e_vc_request_queues_msg(vf, msg); 4235 break; 4236 case VIRTCHNL_OP_ENABLE_CHANNELS: 4237 ret = i40e_vc_add_qch_msg(vf, msg); 4238 break; 4239 case VIRTCHNL_OP_DISABLE_CHANNELS: 4240 ret = i40e_vc_del_qch_msg(vf, msg); 4241 break; 4242 case VIRTCHNL_OP_ADD_CLOUD_FILTER: 4243 ret = i40e_vc_add_cloud_filter(vf, msg); 4244 break; 4245 case VIRTCHNL_OP_DEL_CLOUD_FILTER: 4246 ret = i40e_vc_del_cloud_filter(vf, msg); 4247 break; 4248 case VIRTCHNL_OP_UNKNOWN: 4249 default: 4250 dev_err(&pf->pdev->dev, "Unsupported opcode %d from VF %d\n", 4251 v_opcode, local_vf_id); 4252 ret = i40e_vc_send_resp_to_vf(vf, v_opcode, 4253 -EOPNOTSUPP); 4254 break; 4255 } 4256 4257 return ret; 4258 } 4259 4260 /** 4261 * i40e_vc_process_vflr_event 4262 * @pf: pointer to the PF structure 4263 * 4264 * called from the vlfr irq handler to 4265 * free up VF resources and state variables 4266 **/ 4267 int i40e_vc_process_vflr_event(struct i40e_pf *pf) 4268 { 4269 struct i40e_hw *hw = &pf->hw; 4270 u32 reg, reg_idx, bit_idx; 4271 struct i40e_vf *vf; 4272 int vf_id; 4273 4274 if (!test_bit(__I40E_VFLR_EVENT_PENDING, pf->state)) 4275 return 0; 4276 4277 /* Re-enable the VFLR interrupt cause here, before looking for which 4278 * VF got reset. Otherwise, if another VF gets a reset while the 4279 * first one is being processed, that interrupt will be lost, and 4280 * that VF will be stuck in reset forever. 4281 */ 4282 reg = rd32(hw, I40E_PFINT_ICR0_ENA); 4283 reg |= I40E_PFINT_ICR0_ENA_VFLR_MASK; 4284 wr32(hw, I40E_PFINT_ICR0_ENA, reg); 4285 i40e_flush(hw); 4286 4287 clear_bit(__I40E_VFLR_EVENT_PENDING, pf->state); 4288 for (vf_id = 0; vf_id < pf->num_alloc_vfs; vf_id++) { 4289 reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32; 4290 bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32; 4291 /* read GLGEN_VFLRSTAT register to find out the flr VFs */ 4292 vf = &pf->vf[vf_id]; 4293 reg = rd32(hw, I40E_GLGEN_VFLRSTAT(reg_idx)); 4294 if (reg & BIT(bit_idx)) 4295 /* i40e_reset_vf will clear the bit in GLGEN_VFLRSTAT */ 4296 i40e_reset_vf(vf, true); 4297 } 4298 4299 return 0; 4300 } 4301 4302 /** 4303 * i40e_validate_vf 4304 * @pf: the physical function 4305 * @vf_id: VF identifier 4306 * 4307 * Check that the VF is enabled and the VSI exists. 4308 * 4309 * Returns 0 on success, negative on failure 4310 **/ 4311 static int i40e_validate_vf(struct i40e_pf *pf, int vf_id) 4312 { 4313 struct i40e_vsi *vsi; 4314 struct i40e_vf *vf; 4315 int ret = 0; 4316 4317 if (vf_id >= pf->num_alloc_vfs) { 4318 dev_err(&pf->pdev->dev, 4319 "Invalid VF Identifier %d\n", vf_id); 4320 ret = -EINVAL; 4321 goto err_out; 4322 } 4323 vf = &pf->vf[vf_id]; 4324 vsi = i40e_find_vsi_from_id(pf, vf->lan_vsi_id); 4325 if (!vsi) 4326 ret = -EINVAL; 4327 err_out: 4328 return ret; 4329 } 4330 4331 /** 4332 * i40e_check_vf_init_timeout 4333 * @vf: the virtual function 4334 * 4335 * Check that the VF's initialization was successfully done and if not 4336 * wait up to 300ms for its finish. 4337 * 4338 * Returns true when VF is initialized, false on timeout 4339 **/ 4340 static bool i40e_check_vf_init_timeout(struct i40e_vf *vf) 4341 { 4342 int i; 4343 4344 /* When the VF is resetting wait until it is done. 4345 * It can take up to 200 milliseconds, but wait for 4346 * up to 300 milliseconds to be safe. 4347 */ 4348 for (i = 0; i < 15; i++) { 4349 if (test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) 4350 return true; 4351 msleep(20); 4352 } 4353 4354 if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) { 4355 dev_err(&vf->pf->pdev->dev, 4356 "VF %d still in reset. Try again.\n", vf->vf_id); 4357 return false; 4358 } 4359 4360 return true; 4361 } 4362 4363 /** 4364 * i40e_ndo_set_vf_mac 4365 * @netdev: network interface device structure 4366 * @vf_id: VF identifier 4367 * @mac: mac address 4368 * 4369 * program VF mac address 4370 **/ 4371 int i40e_ndo_set_vf_mac(struct net_device *netdev, int vf_id, u8 *mac) 4372 { 4373 struct i40e_netdev_priv *np = netdev_priv(netdev); 4374 struct i40e_vsi *vsi = np->vsi; 4375 struct i40e_pf *pf = vsi->back; 4376 struct i40e_mac_filter *f; 4377 struct i40e_vf *vf; 4378 int ret = 0; 4379 struct hlist_node *h; 4380 int bkt; 4381 4382 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4383 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4384 return -EAGAIN; 4385 } 4386 4387 /* validate the request */ 4388 ret = i40e_validate_vf(pf, vf_id); 4389 if (ret) 4390 goto error_param; 4391 4392 vf = &pf->vf[vf_id]; 4393 if (!i40e_check_vf_init_timeout(vf)) { 4394 ret = -EAGAIN; 4395 goto error_param; 4396 } 4397 vsi = pf->vsi[vf->lan_vsi_idx]; 4398 4399 if (is_multicast_ether_addr(mac)) { 4400 dev_err(&pf->pdev->dev, 4401 "Invalid Ethernet address %pM for VF %d\n", mac, vf_id); 4402 ret = -EINVAL; 4403 goto error_param; 4404 } 4405 4406 /* Lock once because below invoked function add/del_filter requires 4407 * mac_filter_hash_lock to be held 4408 */ 4409 spin_lock_bh(&vsi->mac_filter_hash_lock); 4410 4411 /* delete the temporary mac address */ 4412 if (!is_zero_ether_addr(vf->default_lan_addr.addr)) 4413 i40e_del_mac_filter(vsi, vf->default_lan_addr.addr); 4414 4415 /* Delete all the filters for this VSI - we're going to kill it 4416 * anyway. 4417 */ 4418 hash_for_each_safe(vsi->mac_filter_hash, bkt, h, f, hlist) 4419 __i40e_del_filter(vsi, f); 4420 4421 spin_unlock_bh(&vsi->mac_filter_hash_lock); 4422 4423 /* program mac filter */ 4424 if (i40e_sync_vsi_filters(vsi)) { 4425 dev_err(&pf->pdev->dev, "Unable to program ucast filters\n"); 4426 ret = -EIO; 4427 goto error_param; 4428 } 4429 ether_addr_copy(vf->default_lan_addr.addr, mac); 4430 4431 if (is_zero_ether_addr(mac)) { 4432 vf->pf_set_mac = false; 4433 dev_info(&pf->pdev->dev, "Removing MAC on VF %d\n", vf_id); 4434 } else { 4435 vf->pf_set_mac = true; 4436 dev_info(&pf->pdev->dev, "Setting MAC %pM on VF %d\n", 4437 mac, vf_id); 4438 } 4439 4440 /* Force the VF interface down so it has to bring up with new MAC 4441 * address 4442 */ 4443 i40e_vc_reset_vf(vf, true); 4444 dev_info(&pf->pdev->dev, "Bring down and up the VF interface to make this change effective.\n"); 4445 4446 error_param: 4447 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4448 return ret; 4449 } 4450 4451 /** 4452 * i40e_ndo_set_vf_port_vlan 4453 * @netdev: network interface device structure 4454 * @vf_id: VF identifier 4455 * @vlan_id: mac address 4456 * @qos: priority setting 4457 * @vlan_proto: vlan protocol 4458 * 4459 * program VF vlan id and/or qos 4460 **/ 4461 int i40e_ndo_set_vf_port_vlan(struct net_device *netdev, int vf_id, 4462 u16 vlan_id, u8 qos, __be16 vlan_proto) 4463 { 4464 u16 vlanprio = vlan_id | (qos << I40E_VLAN_PRIORITY_SHIFT); 4465 struct i40e_netdev_priv *np = netdev_priv(netdev); 4466 bool allmulti = false, alluni = false; 4467 struct i40e_pf *pf = np->vsi->back; 4468 struct i40e_vsi *vsi; 4469 struct i40e_vf *vf; 4470 int ret = 0; 4471 4472 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4473 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4474 return -EAGAIN; 4475 } 4476 4477 /* validate the request */ 4478 ret = i40e_validate_vf(pf, vf_id); 4479 if (ret) 4480 goto error_pvid; 4481 4482 if ((vlan_id > I40E_MAX_VLANID) || (qos > 7)) { 4483 dev_err(&pf->pdev->dev, "Invalid VF Parameters\n"); 4484 ret = -EINVAL; 4485 goto error_pvid; 4486 } 4487 4488 if (vlan_proto != htons(ETH_P_8021Q)) { 4489 dev_err(&pf->pdev->dev, "VF VLAN protocol is not supported\n"); 4490 ret = -EPROTONOSUPPORT; 4491 goto error_pvid; 4492 } 4493 4494 vf = &pf->vf[vf_id]; 4495 if (!i40e_check_vf_init_timeout(vf)) { 4496 ret = -EAGAIN; 4497 goto error_pvid; 4498 } 4499 vsi = pf->vsi[vf->lan_vsi_idx]; 4500 4501 if (le16_to_cpu(vsi->info.pvid) == vlanprio) 4502 /* duplicate request, so just return success */ 4503 goto error_pvid; 4504 4505 i40e_vlan_stripping_enable(vsi); 4506 4507 /* Locked once because multiple functions below iterate list */ 4508 spin_lock_bh(&vsi->mac_filter_hash_lock); 4509 4510 /* Check for condition where there was already a port VLAN ID 4511 * filter set and now it is being deleted by setting it to zero. 4512 * Additionally check for the condition where there was a port 4513 * VLAN but now there is a new and different port VLAN being set. 4514 * Before deleting all the old VLAN filters we must add new ones 4515 * with -1 (I40E_VLAN_ANY) or otherwise we're left with all our 4516 * MAC addresses deleted. 4517 */ 4518 if ((!(vlan_id || qos) || 4519 vlanprio != le16_to_cpu(vsi->info.pvid)) && 4520 vsi->info.pvid) { 4521 ret = i40e_add_vlan_all_mac(vsi, I40E_VLAN_ANY); 4522 if (ret) { 4523 dev_info(&vsi->back->pdev->dev, 4524 "add VF VLAN failed, ret=%d aq_err=%d\n", ret, 4525 vsi->back->hw.aq.asq_last_status); 4526 spin_unlock_bh(&vsi->mac_filter_hash_lock); 4527 goto error_pvid; 4528 } 4529 } 4530 4531 if (vsi->info.pvid) { 4532 /* remove all filters on the old VLAN */ 4533 i40e_rm_vlan_all_mac(vsi, (le16_to_cpu(vsi->info.pvid) & 4534 VLAN_VID_MASK)); 4535 } 4536 4537 spin_unlock_bh(&vsi->mac_filter_hash_lock); 4538 4539 /* disable promisc modes in case they were enabled */ 4540 ret = i40e_config_vf_promiscuous_mode(vf, vf->lan_vsi_id, 4541 allmulti, alluni); 4542 if (ret) { 4543 dev_err(&pf->pdev->dev, "Unable to config VF promiscuous mode\n"); 4544 goto error_pvid; 4545 } 4546 4547 if (vlan_id || qos) 4548 ret = i40e_vsi_add_pvid(vsi, vlanprio); 4549 else 4550 i40e_vsi_remove_pvid(vsi); 4551 spin_lock_bh(&vsi->mac_filter_hash_lock); 4552 4553 if (vlan_id) { 4554 dev_info(&pf->pdev->dev, "Setting VLAN %d, QOS 0x%x on VF %d\n", 4555 vlan_id, qos, vf_id); 4556 4557 /* add new VLAN filter for each MAC */ 4558 ret = i40e_add_vlan_all_mac(vsi, vlan_id); 4559 if (ret) { 4560 dev_info(&vsi->back->pdev->dev, 4561 "add VF VLAN failed, ret=%d aq_err=%d\n", ret, 4562 vsi->back->hw.aq.asq_last_status); 4563 spin_unlock_bh(&vsi->mac_filter_hash_lock); 4564 goto error_pvid; 4565 } 4566 4567 /* remove the previously added non-VLAN MAC filters */ 4568 i40e_rm_vlan_all_mac(vsi, I40E_VLAN_ANY); 4569 } 4570 4571 spin_unlock_bh(&vsi->mac_filter_hash_lock); 4572 4573 if (test_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states)) 4574 alluni = true; 4575 4576 if (test_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states)) 4577 allmulti = true; 4578 4579 /* Schedule the worker thread to take care of applying changes */ 4580 i40e_service_event_schedule(vsi->back); 4581 4582 if (ret) { 4583 dev_err(&pf->pdev->dev, "Unable to update VF vsi context\n"); 4584 goto error_pvid; 4585 } 4586 4587 /* The Port VLAN needs to be saved across resets the same as the 4588 * default LAN MAC address. 4589 */ 4590 vf->port_vlan_id = le16_to_cpu(vsi->info.pvid); 4591 4592 i40e_vc_reset_vf(vf, true); 4593 /* During reset the VF got a new VSI, so refresh a pointer. */ 4594 vsi = pf->vsi[vf->lan_vsi_idx]; 4595 4596 ret = i40e_config_vf_promiscuous_mode(vf, vsi->id, allmulti, alluni); 4597 if (ret) { 4598 dev_err(&pf->pdev->dev, "Unable to config vf promiscuous mode\n"); 4599 goto error_pvid; 4600 } 4601 4602 ret = 0; 4603 4604 error_pvid: 4605 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4606 return ret; 4607 } 4608 4609 /** 4610 * i40e_ndo_set_vf_bw 4611 * @netdev: network interface device structure 4612 * @vf_id: VF identifier 4613 * @min_tx_rate: Minimum Tx rate 4614 * @max_tx_rate: Maximum Tx rate 4615 * 4616 * configure VF Tx rate 4617 **/ 4618 int i40e_ndo_set_vf_bw(struct net_device *netdev, int vf_id, int min_tx_rate, 4619 int max_tx_rate) 4620 { 4621 struct i40e_netdev_priv *np = netdev_priv(netdev); 4622 struct i40e_pf *pf = np->vsi->back; 4623 struct i40e_vsi *vsi; 4624 struct i40e_vf *vf; 4625 int ret = 0; 4626 4627 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4628 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4629 return -EAGAIN; 4630 } 4631 4632 /* validate the request */ 4633 ret = i40e_validate_vf(pf, vf_id); 4634 if (ret) 4635 goto error; 4636 4637 if (min_tx_rate) { 4638 dev_err(&pf->pdev->dev, "Invalid min tx rate (%d) (greater than 0) specified for VF %d.\n", 4639 min_tx_rate, vf_id); 4640 ret = -EINVAL; 4641 goto error; 4642 } 4643 4644 vf = &pf->vf[vf_id]; 4645 if (!i40e_check_vf_init_timeout(vf)) { 4646 ret = -EAGAIN; 4647 goto error; 4648 } 4649 vsi = pf->vsi[vf->lan_vsi_idx]; 4650 4651 ret = i40e_set_bw_limit(vsi, vsi->seid, max_tx_rate); 4652 if (ret) 4653 goto error; 4654 4655 vf->tx_rate = max_tx_rate; 4656 error: 4657 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4658 return ret; 4659 } 4660 4661 /** 4662 * i40e_ndo_get_vf_config 4663 * @netdev: network interface device structure 4664 * @vf_id: VF identifier 4665 * @ivi: VF configuration structure 4666 * 4667 * return VF configuration 4668 **/ 4669 int i40e_ndo_get_vf_config(struct net_device *netdev, 4670 int vf_id, struct ifla_vf_info *ivi) 4671 { 4672 struct i40e_netdev_priv *np = netdev_priv(netdev); 4673 struct i40e_vsi *vsi = np->vsi; 4674 struct i40e_pf *pf = vsi->back; 4675 struct i40e_vf *vf; 4676 int ret = 0; 4677 4678 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4679 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4680 return -EAGAIN; 4681 } 4682 4683 /* validate the request */ 4684 ret = i40e_validate_vf(pf, vf_id); 4685 if (ret) 4686 goto error_param; 4687 4688 vf = &pf->vf[vf_id]; 4689 /* first vsi is always the LAN vsi */ 4690 vsi = pf->vsi[vf->lan_vsi_idx]; 4691 if (!vsi) { 4692 ret = -ENOENT; 4693 goto error_param; 4694 } 4695 4696 ivi->vf = vf_id; 4697 4698 ether_addr_copy(ivi->mac, vf->default_lan_addr.addr); 4699 4700 ivi->max_tx_rate = vf->tx_rate; 4701 ivi->min_tx_rate = 0; 4702 ivi->vlan = le16_to_cpu(vsi->info.pvid) & I40E_VLAN_MASK; 4703 ivi->qos = (le16_to_cpu(vsi->info.pvid) & I40E_PRIORITY_MASK) >> 4704 I40E_VLAN_PRIORITY_SHIFT; 4705 if (vf->link_forced == false) 4706 ivi->linkstate = IFLA_VF_LINK_STATE_AUTO; 4707 else if (vf->link_up == true) 4708 ivi->linkstate = IFLA_VF_LINK_STATE_ENABLE; 4709 else 4710 ivi->linkstate = IFLA_VF_LINK_STATE_DISABLE; 4711 ivi->spoofchk = vf->spoofchk; 4712 ivi->trusted = vf->trusted; 4713 ret = 0; 4714 4715 error_param: 4716 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4717 return ret; 4718 } 4719 4720 /** 4721 * i40e_ndo_set_vf_link_state 4722 * @netdev: network interface device structure 4723 * @vf_id: VF identifier 4724 * @link: required link state 4725 * 4726 * Set the link state of a specified VF, regardless of physical link state 4727 **/ 4728 int i40e_ndo_set_vf_link_state(struct net_device *netdev, int vf_id, int link) 4729 { 4730 struct i40e_netdev_priv *np = netdev_priv(netdev); 4731 struct i40e_pf *pf = np->vsi->back; 4732 struct i40e_link_status *ls = &pf->hw.phy.link_info; 4733 struct virtchnl_pf_event pfe; 4734 struct i40e_hw *hw = &pf->hw; 4735 struct i40e_vf *vf; 4736 int abs_vf_id; 4737 int ret = 0; 4738 4739 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4740 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4741 return -EAGAIN; 4742 } 4743 4744 /* validate the request */ 4745 if (vf_id >= pf->num_alloc_vfs) { 4746 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 4747 ret = -EINVAL; 4748 goto error_out; 4749 } 4750 4751 vf = &pf->vf[vf_id]; 4752 abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id; 4753 4754 pfe.event = VIRTCHNL_EVENT_LINK_CHANGE; 4755 pfe.severity = PF_EVENT_SEVERITY_INFO; 4756 4757 switch (link) { 4758 case IFLA_VF_LINK_STATE_AUTO: 4759 vf->link_forced = false; 4760 i40e_set_vf_link_state(vf, &pfe, ls); 4761 break; 4762 case IFLA_VF_LINK_STATE_ENABLE: 4763 vf->link_forced = true; 4764 vf->link_up = true; 4765 i40e_set_vf_link_state(vf, &pfe, ls); 4766 break; 4767 case IFLA_VF_LINK_STATE_DISABLE: 4768 vf->link_forced = true; 4769 vf->link_up = false; 4770 i40e_set_vf_link_state(vf, &pfe, ls); 4771 break; 4772 default: 4773 ret = -EINVAL; 4774 goto error_out; 4775 } 4776 /* Notify the VF of its new link state */ 4777 i40e_aq_send_msg_to_vf(hw, abs_vf_id, VIRTCHNL_OP_EVENT, 4778 0, (u8 *)&pfe, sizeof(pfe), NULL); 4779 4780 error_out: 4781 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4782 return ret; 4783 } 4784 4785 /** 4786 * i40e_ndo_set_vf_spoofchk 4787 * @netdev: network interface device structure 4788 * @vf_id: VF identifier 4789 * @enable: flag to enable or disable feature 4790 * 4791 * Enable or disable VF spoof checking 4792 **/ 4793 int i40e_ndo_set_vf_spoofchk(struct net_device *netdev, int vf_id, bool enable) 4794 { 4795 struct i40e_netdev_priv *np = netdev_priv(netdev); 4796 struct i40e_vsi *vsi = np->vsi; 4797 struct i40e_pf *pf = vsi->back; 4798 struct i40e_vsi_context ctxt; 4799 struct i40e_hw *hw = &pf->hw; 4800 struct i40e_vf *vf; 4801 int ret = 0; 4802 4803 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4804 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4805 return -EAGAIN; 4806 } 4807 4808 /* validate the request */ 4809 if (vf_id >= pf->num_alloc_vfs) { 4810 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 4811 ret = -EINVAL; 4812 goto out; 4813 } 4814 4815 vf = &(pf->vf[vf_id]); 4816 if (!i40e_check_vf_init_timeout(vf)) { 4817 ret = -EAGAIN; 4818 goto out; 4819 } 4820 4821 if (enable == vf->spoofchk) 4822 goto out; 4823 4824 vf->spoofchk = enable; 4825 memset(&ctxt, 0, sizeof(ctxt)); 4826 ctxt.seid = pf->vsi[vf->lan_vsi_idx]->seid; 4827 ctxt.pf_num = pf->hw.pf_id; 4828 ctxt.info.valid_sections = cpu_to_le16(I40E_AQ_VSI_PROP_SECURITY_VALID); 4829 if (enable) 4830 ctxt.info.sec_flags |= (I40E_AQ_VSI_SEC_FLAG_ENABLE_VLAN_CHK | 4831 I40E_AQ_VSI_SEC_FLAG_ENABLE_MAC_CHK); 4832 ret = i40e_aq_update_vsi_params(hw, &ctxt, NULL); 4833 if (ret) { 4834 dev_err(&pf->pdev->dev, "Error %d updating VSI parameters\n", 4835 ret); 4836 ret = -EIO; 4837 } 4838 out: 4839 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4840 return ret; 4841 } 4842 4843 /** 4844 * i40e_ndo_set_vf_trust 4845 * @netdev: network interface device structure of the pf 4846 * @vf_id: VF identifier 4847 * @setting: trust setting 4848 * 4849 * Enable or disable VF trust setting 4850 **/ 4851 int i40e_ndo_set_vf_trust(struct net_device *netdev, int vf_id, bool setting) 4852 { 4853 struct i40e_netdev_priv *np = netdev_priv(netdev); 4854 struct i40e_pf *pf = np->vsi->back; 4855 struct i40e_vf *vf; 4856 int ret = 0; 4857 4858 if (test_and_set_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state)) { 4859 dev_warn(&pf->pdev->dev, "Unable to configure VFs, other operation is pending.\n"); 4860 return -EAGAIN; 4861 } 4862 4863 /* validate the request */ 4864 if (vf_id >= pf->num_alloc_vfs) { 4865 dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id); 4866 ret = -EINVAL; 4867 goto out; 4868 } 4869 4870 if (pf->flags & I40E_FLAG_MFP_ENABLED) { 4871 dev_err(&pf->pdev->dev, "Trusted VF not supported in MFP mode.\n"); 4872 ret = -EINVAL; 4873 goto out; 4874 } 4875 4876 vf = &pf->vf[vf_id]; 4877 4878 if (setting == vf->trusted) 4879 goto out; 4880 4881 vf->trusted = setting; 4882 4883 /* request PF to sync mac/vlan filters for the VF */ 4884 set_bit(__I40E_MACVLAN_SYNC_PENDING, pf->state); 4885 pf->vsi[vf->lan_vsi_idx]->flags |= I40E_VSI_FLAG_FILTER_CHANGED; 4886 4887 i40e_vc_reset_vf(vf, true); 4888 dev_info(&pf->pdev->dev, "VF %u is now %strusted\n", 4889 vf_id, setting ? "" : "un"); 4890 4891 if (vf->adq_enabled) { 4892 if (!vf->trusted) { 4893 dev_info(&pf->pdev->dev, 4894 "VF %u no longer Trusted, deleting all cloud filters\n", 4895 vf_id); 4896 i40e_del_all_cloud_filters(vf); 4897 } 4898 } 4899 4900 out: 4901 clear_bit(__I40E_VIRTCHNL_OP_PENDING, pf->state); 4902 return ret; 4903 } 4904 4905 /** 4906 * i40e_get_vf_stats - populate some stats for the VF 4907 * @netdev: the netdev of the PF 4908 * @vf_id: the host OS identifier (0-127) 4909 * @vf_stats: pointer to the OS memory to be initialized 4910 */ 4911 int i40e_get_vf_stats(struct net_device *netdev, int vf_id, 4912 struct ifla_vf_stats *vf_stats) 4913 { 4914 struct i40e_netdev_priv *np = netdev_priv(netdev); 4915 struct i40e_pf *pf = np->vsi->back; 4916 struct i40e_eth_stats *stats; 4917 struct i40e_vsi *vsi; 4918 struct i40e_vf *vf; 4919 4920 /* validate the request */ 4921 if (i40e_validate_vf(pf, vf_id)) 4922 return -EINVAL; 4923 4924 vf = &pf->vf[vf_id]; 4925 if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) { 4926 dev_err(&pf->pdev->dev, "VF %d in reset. Try again.\n", vf_id); 4927 return -EBUSY; 4928 } 4929 4930 vsi = pf->vsi[vf->lan_vsi_idx]; 4931 if (!vsi) 4932 return -EINVAL; 4933 4934 i40e_update_eth_stats(vsi); 4935 stats = &vsi->eth_stats; 4936 4937 memset(vf_stats, 0, sizeof(*vf_stats)); 4938 4939 vf_stats->rx_packets = stats->rx_unicast + stats->rx_broadcast + 4940 stats->rx_multicast; 4941 vf_stats->tx_packets = stats->tx_unicast + stats->tx_broadcast + 4942 stats->tx_multicast; 4943 vf_stats->rx_bytes = stats->rx_bytes; 4944 vf_stats->tx_bytes = stats->tx_bytes; 4945 vf_stats->broadcast = stats->rx_broadcast; 4946 vf_stats->multicast = stats->rx_multicast; 4947 vf_stats->rx_dropped = stats->rx_discards; 4948 vf_stats->tx_dropped = stats->tx_discards; 4949 4950 return 0; 4951 } 4952