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