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