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