drivers/net/ethernet/intel/i40e/i40e_virtchnl_pf.c

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