847 lines · c
1// SPDX-License-Identifier: GPL-2.02/* Copyright (C) 2019-2021, Intel Corporation. */3 4#include "ice_vsi_vlan_lib.h"5#include "ice_lib.h"6#include "ice_fltr.h"7#include "ice.h"8 9static void print_invalid_tpid(struct ice_vsi *vsi, u16 tpid)10{11 dev_err(ice_pf_to_dev(vsi->back), "%s %d specified invalid VLAN tpid 0x%04x\n",12 ice_vsi_type_str(vsi->type), vsi->idx, tpid);13}14 15/**16 * validate_vlan - check if the ice_vlan passed in is valid17 * @vsi: VSI used for printing error message18 * @vlan: ice_vlan structure to validate19 *20 * Return true if the VLAN TPID is valid or if the VLAN TPID is 0 and the VLAN21 * VID is 0, which allows for non-zero VLAN filters with the specified VLAN TPID22 * and untagged VLAN 0 filters to be added to the prune list respectively.23 */24static bool validate_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)25{26 if (vlan->tpid != ETH_P_8021Q && vlan->tpid != ETH_P_8021AD &&27 vlan->tpid != ETH_P_QINQ1 && (vlan->tpid || vlan->vid)) {28 print_invalid_tpid(vsi, vlan->tpid);29 return false;30 }31 32 return true;33}34 35/**36 * ice_vsi_add_vlan - default add VLAN implementation for all VSI types37 * @vsi: VSI being configured38 * @vlan: VLAN filter to add39 */40int ice_vsi_add_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)41{42 int err;43 44 if (!validate_vlan(vsi, vlan))45 return -EINVAL;46 47 err = ice_fltr_add_vlan(vsi, vlan);48 if (!err)49 vsi->num_vlan++;50 else if (err == -EEXIST)51 err = 0;52 else53 dev_err(ice_pf_to_dev(vsi->back), "Failure Adding VLAN %d on VSI %i, status %d\n",54 vlan->vid, vsi->vsi_num, err);55 56 return err;57}58 59/**60 * ice_vsi_del_vlan - default del VLAN implementation for all VSI types61 * @vsi: VSI being configured62 * @vlan: VLAN filter to delete63 */64int ice_vsi_del_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)65{66 struct ice_pf *pf = vsi->back;67 struct device *dev;68 int err;69 70 if (!validate_vlan(vsi, vlan))71 return -EINVAL;72 73 dev = ice_pf_to_dev(pf);74 75 err = ice_fltr_remove_vlan(vsi, vlan);76 if (!err)77 vsi->num_vlan--;78 else if (err == -ENOENT || err == -EBUSY)79 err = 0;80 else81 dev_err(dev, "Error removing VLAN %d on VSI %i error: %d\n",82 vlan->vid, vsi->vsi_num, err);83 84 return err;85}86 87/**88 * ice_vsi_manage_vlan_insertion - Manage VLAN insertion for the VSI for Tx89 * @vsi: the VSI being changed90 */91static int ice_vsi_manage_vlan_insertion(struct ice_vsi *vsi)92{93 struct ice_hw *hw = &vsi->back->hw;94 struct ice_vsi_ctx *ctxt;95 int err;96 97 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);98 if (!ctxt)99 return -ENOMEM;100 101 /* Here we are configuring the VSI to let the driver add VLAN tags by102 * setting inner_vlan_flags to ICE_AQ_VSI_INNER_VLAN_TX_MODE_ALL. The actual VLAN tag103 * insertion happens in the Tx hot path, in ice_tx_map.104 */105 ctxt->info.inner_vlan_flags = ICE_AQ_VSI_INNER_VLAN_TX_MODE_ALL;106 107 /* Preserve existing VLAN strip setting */108 ctxt->info.inner_vlan_flags |= (vsi->info.inner_vlan_flags &109 ICE_AQ_VSI_INNER_VLAN_EMODE_M);110 111 ctxt->info.valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_VLAN_VALID);112 113 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);114 if (err) {115 dev_err(ice_pf_to_dev(vsi->back), "update VSI for VLAN insert failed, err %d aq_err %s\n",116 err, ice_aq_str(hw->adminq.sq_last_status));117 goto out;118 }119 120 vsi->info.inner_vlan_flags = ctxt->info.inner_vlan_flags;121out:122 kfree(ctxt);123 return err;124}125 126/**127 * ice_vsi_manage_vlan_stripping - Manage VLAN stripping for the VSI for Rx128 * @vsi: the VSI being changed129 * @ena: boolean value indicating if this is a enable or disable request130 */131static int ice_vsi_manage_vlan_stripping(struct ice_vsi *vsi, bool ena)132{133 struct ice_hw *hw = &vsi->back->hw;134 struct ice_vsi_ctx *ctxt;135 u8 *ivf;136 int err;137 138 /* do not allow modifying VLAN stripping when a port VLAN is configured139 * on this VSI140 */141 if (vsi->info.port_based_inner_vlan)142 return 0;143 144 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);145 if (!ctxt)146 return -ENOMEM;147 148 ivf = &ctxt->info.inner_vlan_flags;149 150 /* Here we are configuring what the VSI should do with the VLAN tag in151 * the Rx packet. We can either leave the tag in the packet or put it in152 * the Rx descriptor.153 */154 if (ena) {155 /* Strip VLAN tag from Rx packet and put it in the desc */156 *ivf = FIELD_PREP(ICE_AQ_VSI_INNER_VLAN_EMODE_M,157 ICE_AQ_VSI_INNER_VLAN_EMODE_STR_BOTH);158 } else {159 /* Disable stripping. Leave tag in packet */160 *ivf = FIELD_PREP(ICE_AQ_VSI_INNER_VLAN_EMODE_M,161 ICE_AQ_VSI_INNER_VLAN_EMODE_NOTHING);162 }163 164 /* Allow all packets untagged/tagged */165 *ivf |= ICE_AQ_VSI_INNER_VLAN_TX_MODE_ALL;166 167 ctxt->info.valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_VLAN_VALID);168 169 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);170 if (err) {171 dev_err(ice_pf_to_dev(vsi->back), "update VSI for VLAN strip failed, ena = %d err %d aq_err %s\n",172 ena, err, ice_aq_str(hw->adminq.sq_last_status));173 goto out;174 }175 176 vsi->info.inner_vlan_flags = ctxt->info.inner_vlan_flags;177out:178 kfree(ctxt);179 return err;180}181 182int ice_vsi_ena_inner_stripping(struct ice_vsi *vsi, const u16 tpid)183{184 if (tpid != ETH_P_8021Q) {185 print_invalid_tpid(vsi, tpid);186 return -EINVAL;187 }188 189 return ice_vsi_manage_vlan_stripping(vsi, true);190}191 192int ice_vsi_dis_inner_stripping(struct ice_vsi *vsi)193{194 return ice_vsi_manage_vlan_stripping(vsi, false);195}196 197int ice_vsi_ena_inner_insertion(struct ice_vsi *vsi, const u16 tpid)198{199 if (tpid != ETH_P_8021Q) {200 print_invalid_tpid(vsi, tpid);201 return -EINVAL;202 }203 204 return ice_vsi_manage_vlan_insertion(vsi);205}206 207int ice_vsi_dis_inner_insertion(struct ice_vsi *vsi)208{209 return ice_vsi_manage_vlan_insertion(vsi);210}211 212static void213ice_save_vlan_info(struct ice_aqc_vsi_props *info,214 struct ice_vsi_vlan_info *vlan)215{216 vlan->sw_flags2 = info->sw_flags2;217 vlan->inner_vlan_flags = info->inner_vlan_flags;218 vlan->outer_vlan_flags = info->outer_vlan_flags;219}220 221static void222ice_restore_vlan_info(struct ice_aqc_vsi_props *info,223 struct ice_vsi_vlan_info *vlan)224{225 info->sw_flags2 = vlan->sw_flags2;226 info->inner_vlan_flags = vlan->inner_vlan_flags;227 info->outer_vlan_flags = vlan->outer_vlan_flags;228}229 230/**231 * __ice_vsi_set_inner_port_vlan - set port VLAN VSI context settings to enable a port VLAN232 * @vsi: the VSI to update233 * @pvid_info: VLAN ID and QoS used to set the PVID VSI context field234 */235static int __ice_vsi_set_inner_port_vlan(struct ice_vsi *vsi, u16 pvid_info)236{237 struct ice_hw *hw = &vsi->back->hw;238 struct ice_aqc_vsi_props *info;239 struct ice_vsi_ctx *ctxt;240 int ret;241 242 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);243 if (!ctxt)244 return -ENOMEM;245 246 ice_save_vlan_info(&vsi->info, &vsi->vlan_info);247 ctxt->info = vsi->info;248 info = &ctxt->info;249 info->inner_vlan_flags = ICE_AQ_VSI_INNER_VLAN_TX_MODE_ACCEPTUNTAGGED |250 ICE_AQ_VSI_INNER_VLAN_INSERT_PVID |251 ICE_AQ_VSI_INNER_VLAN_EMODE_STR;252 info->sw_flags2 |= ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA;253 254 info->port_based_inner_vlan = cpu_to_le16(pvid_info);255 info->valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_VLAN_VALID |256 ICE_AQ_VSI_PROP_SW_VALID);257 258 ret = ice_update_vsi(hw, vsi->idx, ctxt, NULL);259 if (ret) {260 dev_info(ice_hw_to_dev(hw), "update VSI for port VLAN failed, err %d aq_err %s\n",261 ret, ice_aq_str(hw->adminq.sq_last_status));262 goto out;263 }264 265 vsi->info.inner_vlan_flags = info->inner_vlan_flags;266 vsi->info.sw_flags2 = info->sw_flags2;267 vsi->info.port_based_inner_vlan = info->port_based_inner_vlan;268out:269 kfree(ctxt);270 return ret;271}272 273int ice_vsi_set_inner_port_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)274{275 u16 port_vlan_info;276 277 if (vlan->tpid != ETH_P_8021Q)278 return -EINVAL;279 280 if (vlan->prio > 7)281 return -EINVAL;282 283 port_vlan_info = vlan->vid | (vlan->prio << VLAN_PRIO_SHIFT);284 285 return __ice_vsi_set_inner_port_vlan(vsi, port_vlan_info);286}287 288int ice_vsi_clear_inner_port_vlan(struct ice_vsi *vsi)289{290 struct ice_hw *hw = &vsi->back->hw;291 struct ice_aqc_vsi_props *info;292 struct ice_vsi_ctx *ctxt;293 int ret;294 295 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);296 if (!ctxt)297 return -ENOMEM;298 299 ice_restore_vlan_info(&vsi->info, &vsi->vlan_info);300 vsi->info.port_based_inner_vlan = 0;301 ctxt->info = vsi->info;302 info = &ctxt->info;303 info->valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_VLAN_VALID |304 ICE_AQ_VSI_PROP_SW_VALID);305 306 ret = ice_update_vsi(hw, vsi->idx, ctxt, NULL);307 if (ret)308 dev_err(ice_hw_to_dev(hw), "update VSI for port VLAN failed, err %d aq_err %s\n",309 ret, ice_aq_str(hw->adminq.sq_last_status));310 311 kfree(ctxt);312 return ret;313}314 315/**316 * ice_cfg_vlan_pruning - enable or disable VLAN pruning on the VSI317 * @vsi: VSI to enable or disable VLAN pruning on318 * @ena: set to true to enable VLAN pruning and false to disable it319 *320 * returns 0 if VSI is updated, negative otherwise321 */322static int ice_cfg_vlan_pruning(struct ice_vsi *vsi, bool ena)323{324 struct ice_vsi_ctx *ctxt;325 struct ice_pf *pf;326 int status;327 328 if (!vsi)329 return -EINVAL;330 331 /* Don't enable VLAN pruning if the netdev is currently in promiscuous332 * mode. VLAN pruning will be enabled when the interface exits333 * promiscuous mode if any VLAN filters are active.334 */335 if (vsi->netdev && vsi->netdev->flags & IFF_PROMISC && ena)336 return 0;337 338 pf = vsi->back;339 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);340 if (!ctxt)341 return -ENOMEM;342 343 ctxt->info = vsi->info;344 345 if (ena)346 ctxt->info.sw_flags2 |= ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA;347 else348 ctxt->info.sw_flags2 &= ~ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA;349 350 ctxt->info.valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_SW_VALID);351 352 status = ice_update_vsi(&pf->hw, vsi->idx, ctxt, NULL);353 if (status) {354 netdev_err(vsi->netdev, "%sabling VLAN pruning on VSI handle: %d, VSI HW ID: %d failed, err = %d, aq_err = %s\n",355 ena ? "En" : "Dis", vsi->idx, vsi->vsi_num, status,356 ice_aq_str(pf->hw.adminq.sq_last_status));357 goto err_out;358 }359 360 vsi->info.sw_flags2 = ctxt->info.sw_flags2;361 362 kfree(ctxt);363 return 0;364 365err_out:366 kfree(ctxt);367 return status;368}369 370int ice_vsi_ena_rx_vlan_filtering(struct ice_vsi *vsi)371{372 return ice_cfg_vlan_pruning(vsi, true);373}374 375int ice_vsi_dis_rx_vlan_filtering(struct ice_vsi *vsi)376{377 return ice_cfg_vlan_pruning(vsi, false);378}379 380static int ice_cfg_vlan_antispoof(struct ice_vsi *vsi, bool enable)381{382 struct ice_vsi_ctx *ctx;383 int err;384 385 ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);386 if (!ctx)387 return -ENOMEM;388 389 ctx->info.sec_flags = vsi->info.sec_flags;390 ctx->info.valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_SECURITY_VALID);391 392 if (enable)393 ctx->info.sec_flags |= ICE_AQ_VSI_SEC_TX_VLAN_PRUNE_ENA <<394 ICE_AQ_VSI_SEC_TX_PRUNE_ENA_S;395 else396 ctx->info.sec_flags &= ~(ICE_AQ_VSI_SEC_TX_VLAN_PRUNE_ENA <<397 ICE_AQ_VSI_SEC_TX_PRUNE_ENA_S);398 399 err = ice_update_vsi(&vsi->back->hw, vsi->idx, ctx, NULL);400 if (err)401 dev_err(ice_pf_to_dev(vsi->back), "Failed to configure Tx VLAN anti-spoof %s for VSI %d, error %d\n",402 enable ? "ON" : "OFF", vsi->vsi_num, err);403 else404 vsi->info.sec_flags = ctx->info.sec_flags;405 406 kfree(ctx);407 408 return err;409}410 411int ice_vsi_ena_tx_vlan_filtering(struct ice_vsi *vsi)412{413 return ice_cfg_vlan_antispoof(vsi, true);414}415 416int ice_vsi_dis_tx_vlan_filtering(struct ice_vsi *vsi)417{418 return ice_cfg_vlan_antispoof(vsi, false);419}420 421/**422 * tpid_to_vsi_outer_vlan_type - convert from TPID to VSI context based tag_type423 * @tpid: tpid used to translate into VSI context based tag_type424 * @tag_type: output variable to hold the VSI context based tag type425 */426static int tpid_to_vsi_outer_vlan_type(u16 tpid, u8 *tag_type)427{428 switch (tpid) {429 case ETH_P_8021Q:430 *tag_type = ICE_AQ_VSI_OUTER_TAG_VLAN_8100;431 break;432 case ETH_P_8021AD:433 *tag_type = ICE_AQ_VSI_OUTER_TAG_STAG;434 break;435 case ETH_P_QINQ1:436 *tag_type = ICE_AQ_VSI_OUTER_TAG_VLAN_9100;437 break;438 default:439 *tag_type = 0;440 return -EINVAL;441 }442 443 return 0;444}445 446/**447 * ice_vsi_ena_outer_stripping - enable outer VLAN stripping448 * @vsi: VSI to configure449 * @tpid: TPID to enable outer VLAN stripping for450 *451 * Enable outer VLAN stripping via VSI context. This function should only be452 * used if DVM is supported. Also, this function should never be called directly453 * as it should be part of ice_vsi_vlan_ops if it's needed.454 *455 * Since the VSI context only supports a single TPID for insertion and456 * stripping, setting the TPID for stripping will affect the TPID for insertion.457 * Callers need to be aware of this limitation.458 *459 * Only modify outer VLAN stripping settings and the VLAN TPID. Outer VLAN460 * insertion settings are unmodified.461 *462 * This enables hardware to strip a VLAN tag with the specified TPID to be463 * stripped from the packet and placed in the receive descriptor.464 */465int ice_vsi_ena_outer_stripping(struct ice_vsi *vsi, u16 tpid)466{467 struct ice_hw *hw = &vsi->back->hw;468 struct ice_vsi_ctx *ctxt;469 u8 tag_type;470 int err;471 472 /* do not allow modifying VLAN stripping when a port VLAN is configured473 * on this VSI474 */475 if (vsi->info.port_based_outer_vlan)476 return 0;477 478 if (tpid_to_vsi_outer_vlan_type(tpid, &tag_type))479 return -EINVAL;480 481 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);482 if (!ctxt)483 return -ENOMEM;484 485 ctxt->info.valid_sections =486 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID);487 /* clear current outer VLAN strip settings */488 ctxt->info.outer_vlan_flags = vsi->info.outer_vlan_flags &489 ~(ICE_AQ_VSI_OUTER_VLAN_EMODE_M | ICE_AQ_VSI_OUTER_TAG_TYPE_M);490 ctxt->info.outer_vlan_flags |=491 /* we want EMODE_SHOW_BOTH, but that value is zero, so the line492 * above clears it well enough that we don't need to try to set493 * zero here, so just do the tag type494 */495 FIELD_PREP(ICE_AQ_VSI_OUTER_TAG_TYPE_M, tag_type);496 497 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);498 if (err)499 dev_err(ice_pf_to_dev(vsi->back), "update VSI for enabling outer VLAN stripping failed, err %d aq_err %s\n",500 err, ice_aq_str(hw->adminq.sq_last_status));501 else502 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;503 504 kfree(ctxt);505 return err;506}507 508/**509 * ice_vsi_dis_outer_stripping - disable outer VLAN stripping510 * @vsi: VSI to configure511 *512 * Disable outer VLAN stripping via VSI context. This function should only be513 * used if DVM is supported. Also, this function should never be called directly514 * as it should be part of ice_vsi_vlan_ops if it's needed.515 *516 * Only modify the outer VLAN stripping settings. The VLAN TPID and outer VLAN517 * insertion settings are unmodified.518 *519 * This tells the hardware to not strip any VLAN tagged packets, thus leaving520 * them in the packet. This enables software offloaded VLAN stripping and521 * disables hardware offloaded VLAN stripping.522 */523int ice_vsi_dis_outer_stripping(struct ice_vsi *vsi)524{525 struct ice_hw *hw = &vsi->back->hw;526 struct ice_vsi_ctx *ctxt;527 int err;528 529 if (vsi->info.port_based_outer_vlan)530 return 0;531 532 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);533 if (!ctxt)534 return -ENOMEM;535 536 ctxt->info.valid_sections =537 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID);538 /* clear current outer VLAN strip settings */539 ctxt->info.outer_vlan_flags = vsi->info.outer_vlan_flags &540 ~ICE_AQ_VSI_OUTER_VLAN_EMODE_M;541 ctxt->info.outer_vlan_flags |= ICE_AQ_VSI_OUTER_VLAN_EMODE_NOTHING <<542 ICE_AQ_VSI_OUTER_VLAN_EMODE_S;543 544 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);545 if (err)546 dev_err(ice_pf_to_dev(vsi->back), "update VSI for disabling outer VLAN stripping failed, err %d aq_err %s\n",547 err, ice_aq_str(hw->adminq.sq_last_status));548 else549 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;550 551 kfree(ctxt);552 return err;553}554 555/**556 * ice_vsi_ena_outer_insertion - enable outer VLAN insertion557 * @vsi: VSI to configure558 * @tpid: TPID to enable outer VLAN insertion for559 *560 * Enable outer VLAN insertion via VSI context. This function should only be561 * used if DVM is supported. Also, this function should never be called directly562 * as it should be part of ice_vsi_vlan_ops if it's needed.563 *564 * Since the VSI context only supports a single TPID for insertion and565 * stripping, setting the TPID for insertion will affect the TPID for stripping.566 * Callers need to be aware of this limitation.567 *568 * Only modify outer VLAN insertion settings and the VLAN TPID. Outer VLAN569 * stripping settings are unmodified.570 *571 * This allows a VLAN tag with the specified TPID to be inserted in the transmit572 * descriptor.573 */574int ice_vsi_ena_outer_insertion(struct ice_vsi *vsi, u16 tpid)575{576 struct ice_hw *hw = &vsi->back->hw;577 struct ice_vsi_ctx *ctxt;578 u8 tag_type;579 int err;580 581 if (vsi->info.port_based_outer_vlan)582 return 0;583 584 if (tpid_to_vsi_outer_vlan_type(tpid, &tag_type))585 return -EINVAL;586 587 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);588 if (!ctxt)589 return -ENOMEM;590 591 ctxt->info.valid_sections =592 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID);593 /* clear current outer VLAN insertion settings */594 ctxt->info.outer_vlan_flags = vsi->info.outer_vlan_flags &595 ~(ICE_AQ_VSI_OUTER_VLAN_PORT_BASED_INSERT |596 ICE_AQ_VSI_OUTER_VLAN_BLOCK_TX_DESC |597 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_M |598 ICE_AQ_VSI_OUTER_TAG_TYPE_M);599 ctxt->info.outer_vlan_flags |=600 FIELD_PREP(ICE_AQ_VSI_OUTER_VLAN_TX_MODE_M,601 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_ALL) |602 FIELD_PREP(ICE_AQ_VSI_OUTER_TAG_TYPE_M, tag_type);603 604 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);605 if (err)606 dev_err(ice_pf_to_dev(vsi->back), "update VSI for enabling outer VLAN insertion failed, err %d aq_err %s\n",607 err, ice_aq_str(hw->adminq.sq_last_status));608 else609 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;610 611 kfree(ctxt);612 return err;613}614 615/**616 * ice_vsi_dis_outer_insertion - disable outer VLAN insertion617 * @vsi: VSI to configure618 *619 * Disable outer VLAN insertion via VSI context. This function should only be620 * used if DVM is supported. Also, this function should never be called directly621 * as it should be part of ice_vsi_vlan_ops if it's needed.622 *623 * Only modify the outer VLAN insertion settings. The VLAN TPID and outer VLAN624 * settings are unmodified.625 *626 * This tells the hardware to not allow any VLAN tagged packets in the transmit627 * descriptor. This enables software offloaded VLAN insertion and disables628 * hardware offloaded VLAN insertion.629 */630int ice_vsi_dis_outer_insertion(struct ice_vsi *vsi)631{632 struct ice_hw *hw = &vsi->back->hw;633 struct ice_vsi_ctx *ctxt;634 int err;635 636 if (vsi->info.port_based_outer_vlan)637 return 0;638 639 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);640 if (!ctxt)641 return -ENOMEM;642 643 ctxt->info.valid_sections =644 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID);645 /* clear current outer VLAN insertion settings */646 ctxt->info.outer_vlan_flags = vsi->info.outer_vlan_flags &647 ~(ICE_AQ_VSI_OUTER_VLAN_PORT_BASED_INSERT |648 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_M);649 ctxt->info.outer_vlan_flags |=650 ICE_AQ_VSI_OUTER_VLAN_BLOCK_TX_DESC |651 FIELD_PREP(ICE_AQ_VSI_OUTER_VLAN_TX_MODE_M,652 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_ALL);653 654 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);655 if (err)656 dev_err(ice_pf_to_dev(vsi->back), "update VSI for disabling outer VLAN insertion failed, err %d aq_err %s\n",657 err, ice_aq_str(hw->adminq.sq_last_status));658 else659 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;660 661 kfree(ctxt);662 return err;663}664 665/**666 * __ice_vsi_set_outer_port_vlan - set the outer port VLAN and related settings667 * @vsi: VSI to configure668 * @vlan_info: packed u16 that contains the VLAN prio and ID669 * @tpid: TPID of the port VLAN670 *671 * Set the port VLAN prio, ID, and TPID.672 *673 * Enable VLAN pruning so the VSI doesn't receive any traffic that doesn't match674 * a VLAN prune rule. The caller should take care to add a VLAN prune rule that675 * matches the port VLAN ID and TPID.676 *677 * Tell hardware to strip outer VLAN tagged packets on receive and don't put678 * them in the receive descriptor. VSI(s) in port VLANs should not be aware of679 * the port VLAN ID or TPID they are assigned to.680 *681 * Tell hardware to prevent outer VLAN tag insertion on transmit and only allow682 * untagged outer packets from the transmit descriptor.683 *684 * Also, tell the hardware to insert the port VLAN on transmit.685 */686static int687__ice_vsi_set_outer_port_vlan(struct ice_vsi *vsi, u16 vlan_info, u16 tpid)688{689 struct ice_hw *hw = &vsi->back->hw;690 struct ice_vsi_ctx *ctxt;691 u8 tag_type;692 int err;693 694 if (tpid_to_vsi_outer_vlan_type(tpid, &tag_type))695 return -EINVAL;696 697 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);698 if (!ctxt)699 return -ENOMEM;700 701 ice_save_vlan_info(&vsi->info, &vsi->vlan_info);702 ctxt->info = vsi->info;703 704 ctxt->info.sw_flags2 |= ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA;705 706 ctxt->info.port_based_outer_vlan = cpu_to_le16(vlan_info);707 ctxt->info.outer_vlan_flags =708 (ICE_AQ_VSI_OUTER_VLAN_EMODE_SHOW <<709 ICE_AQ_VSI_OUTER_VLAN_EMODE_S) |710 FIELD_PREP(ICE_AQ_VSI_OUTER_TAG_TYPE_M, tag_type) |711 ICE_AQ_VSI_OUTER_VLAN_BLOCK_TX_DESC |712 (ICE_AQ_VSI_OUTER_VLAN_TX_MODE_ACCEPTUNTAGGED <<713 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_S) |714 ICE_AQ_VSI_OUTER_VLAN_PORT_BASED_INSERT;715 716 ctxt->info.valid_sections =717 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID |718 ICE_AQ_VSI_PROP_SW_VALID);719 720 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);721 if (err) {722 dev_err(ice_pf_to_dev(vsi->back), "update VSI for setting outer port based VLAN failed, err %d aq_err %s\n",723 err, ice_aq_str(hw->adminq.sq_last_status));724 } else {725 vsi->info.port_based_outer_vlan = ctxt->info.port_based_outer_vlan;726 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;727 vsi->info.sw_flags2 = ctxt->info.sw_flags2;728 }729 730 kfree(ctxt);731 return err;732}733 734/**735 * ice_vsi_set_outer_port_vlan - public version of __ice_vsi_set_outer_port_vlan736 * @vsi: VSI to configure737 * @vlan: ice_vlan structure used to set the port VLAN738 *739 * Set the outer port VLAN via VSI context. This function should only be740 * used if DVM is supported. Also, this function should never be called directly741 * as it should be part of ice_vsi_vlan_ops if it's needed.742 *743 * Use the ice_vlan structure passed in to set this VSI in a port VLAN.744 */745int ice_vsi_set_outer_port_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)746{747 u16 port_vlan_info;748 749 if (vlan->prio > (VLAN_PRIO_MASK >> VLAN_PRIO_SHIFT))750 return -EINVAL;751 752 port_vlan_info = vlan->vid | (vlan->prio << VLAN_PRIO_SHIFT);753 754 return __ice_vsi_set_outer_port_vlan(vsi, port_vlan_info, vlan->tpid);755}756 757/**758 * ice_vsi_clear_outer_port_vlan - clear outer port vlan759 * @vsi: VSI to configure760 *761 * The function is restoring previously set vlan config (saved in762 * vsi->vlan_info). Setting happens in port vlan configuration.763 */764int ice_vsi_clear_outer_port_vlan(struct ice_vsi *vsi)765{766 struct ice_hw *hw = &vsi->back->hw;767 struct ice_vsi_ctx *ctxt;768 int err;769 770 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);771 if (!ctxt)772 return -ENOMEM;773 774 ice_restore_vlan_info(&vsi->info, &vsi->vlan_info);775 vsi->info.port_based_outer_vlan = 0;776 ctxt->info = vsi->info;777 778 ctxt->info.valid_sections =779 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID |780 ICE_AQ_VSI_PROP_SW_VALID);781 782 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);783 if (err)784 dev_err(ice_pf_to_dev(vsi->back), "update VSI for clearing outer port based VLAN failed, err %d aq_err %s\n",785 err, ice_aq_str(hw->adminq.sq_last_status));786 787 kfree(ctxt);788 return err;789}790 791int ice_vsi_clear_port_vlan(struct ice_vsi *vsi)792{793 struct ice_hw *hw = &vsi->back->hw;794 struct ice_vsi_ctx *ctxt;795 int err;796 797 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL);798 if (!ctxt)799 return -ENOMEM;800 801 ctxt->info = vsi->info;802 803 ctxt->info.port_based_outer_vlan = 0;804 ctxt->info.port_based_inner_vlan = 0;805 806 ctxt->info.inner_vlan_flags =807 FIELD_PREP(ICE_AQ_VSI_INNER_VLAN_TX_MODE_M,808 ICE_AQ_VSI_INNER_VLAN_TX_MODE_ALL);809 if (ice_is_dvm_ena(hw)) {810 ctxt->info.inner_vlan_flags |=811 FIELD_PREP(ICE_AQ_VSI_INNER_VLAN_EMODE_M,812 ICE_AQ_VSI_INNER_VLAN_EMODE_NOTHING);813 ctxt->info.outer_vlan_flags =814 FIELD_PREP(ICE_AQ_VSI_OUTER_VLAN_TX_MODE_M,815 ICE_AQ_VSI_OUTER_VLAN_TX_MODE_ALL);816 ctxt->info.outer_vlan_flags |=817 FIELD_PREP(ICE_AQ_VSI_OUTER_TAG_TYPE_M,818 ICE_AQ_VSI_OUTER_TAG_VLAN_8100);819 ctxt->info.outer_vlan_flags |=820 ICE_AQ_VSI_OUTER_VLAN_EMODE_NOTHING <<821 ICE_AQ_VSI_OUTER_VLAN_EMODE_S;822 }823 824 ctxt->info.sw_flags2 &= ~ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA;825 ctxt->info.valid_sections =826 cpu_to_le16(ICE_AQ_VSI_PROP_OUTER_TAG_VALID |827 ICE_AQ_VSI_PROP_VLAN_VALID |828 ICE_AQ_VSI_PROP_SW_VALID);829 830 err = ice_update_vsi(hw, vsi->idx, ctxt, NULL);831 if (err) {832 dev_err(ice_pf_to_dev(vsi->back), "update VSI for clearing port based VLAN failed, err %d aq_err %s\n",833 err, ice_aq_str(hw->adminq.sq_last_status));834 } else {835 vsi->info.port_based_outer_vlan =836 ctxt->info.port_based_outer_vlan;837 vsi->info.port_based_inner_vlan =838 ctxt->info.port_based_inner_vlan;839 vsi->info.outer_vlan_flags = ctxt->info.outer_vlan_flags;840 vsi->info.inner_vlan_flags = ctxt->info.inner_vlan_flags;841 vsi->info.sw_flags2 = ctxt->info.sw_flags2;842 }843 844 kfree(ctxt);845 return err;846}847