1 /* SPDX-License-Identifier: BSD-3-Clause 2 * Copyright 2015 6WIND S.A. 3 * Copyright 2015 Mellanox Technologies, Ltd 4 */ 5 6 #include <stddef.h> 7 #include <errno.h> 8 #include <stdint.h> 9 #include <unistd.h> 10 11 #include <ethdev_driver.h> 12 #include <rte_common.h> 13 #include <rte_malloc.h> 14 #include <rte_hypervisor.h> 15 16 #include "mlx5.h" 17 #include "mlx5_autoconf.h" 18 #include "mlx5_rxtx.h" 19 #include "mlx5_utils.h" 20 #include "mlx5_devx.h" 21 22 /** 23 * DPDK callback to configure a VLAN filter. 24 * 25 * @param dev 26 * Pointer to Ethernet device structure. 27 * @param vlan_id 28 * VLAN ID to filter. 29 * @param on 30 * Toggle filter. 31 * 32 * @return 33 * 0 on success, a negative errno value otherwise and rte_errno is set. 34 */ 35 int 36 mlx5_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on) 37 { 38 struct mlx5_priv *priv = dev->data->dev_private; 39 unsigned int i; 40 41 DRV_LOG(DEBUG, "port %u %s VLAN filter ID %" PRIu16, 42 dev->data->port_id, (on ? "enable" : "disable"), vlan_id); 43 MLX5_ASSERT(priv->vlan_filter_n <= RTE_DIM(priv->vlan_filter)); 44 for (i = 0; (i != priv->vlan_filter_n); ++i) 45 if (priv->vlan_filter[i] == vlan_id) 46 break; 47 /* Check if there's room for another VLAN filter. */ 48 if (i == RTE_DIM(priv->vlan_filter)) { 49 rte_errno = ENOMEM; 50 return -rte_errno; 51 } 52 if (i < priv->vlan_filter_n) { 53 MLX5_ASSERT(priv->vlan_filter_n != 0); 54 /* Enabling an existing VLAN filter has no effect. */ 55 if (on) 56 goto out; 57 /* Remove VLAN filter from list. */ 58 --priv->vlan_filter_n; 59 memmove(&priv->vlan_filter[i], 60 &priv->vlan_filter[i + 1], 61 sizeof(priv->vlan_filter[i]) * 62 (priv->vlan_filter_n - i)); 63 priv->vlan_filter[priv->vlan_filter_n] = 0; 64 } else { 65 MLX5_ASSERT(i == priv->vlan_filter_n); 66 /* Disabling an unknown VLAN filter has no effect. */ 67 if (!on) 68 goto out; 69 /* Add new VLAN filter. */ 70 priv->vlan_filter[priv->vlan_filter_n] = vlan_id; 71 ++priv->vlan_filter_n; 72 } 73 out: 74 if (dev->data->dev_started) 75 return mlx5_traffic_restart(dev); 76 return 0; 77 } 78 79 /** 80 * Callback to set/reset VLAN stripping for a specific queue. 81 * 82 * @param dev 83 * Pointer to Ethernet device structure. 84 * @param queue 85 * RX queue index. 86 * @param on 87 * Enable/disable VLAN stripping. 88 */ 89 void 90 mlx5_vlan_strip_queue_set(struct rte_eth_dev *dev, uint16_t queue, int on) 91 { 92 struct mlx5_priv *priv = dev->data->dev_private; 93 struct mlx5_rxq_data *rxq = (*priv->rxqs)[queue]; 94 struct mlx5_rxq_ctrl *rxq_ctrl = 95 container_of(rxq, struct mlx5_rxq_ctrl, rxq); 96 int ret = 0; 97 98 /* Validate hw support */ 99 if (!priv->config.hw_vlan_strip) { 100 DRV_LOG(ERR, "port %u VLAN stripping is not supported", 101 dev->data->port_id); 102 return; 103 } 104 /* Validate queue number */ 105 if (queue >= priv->rxqs_n) { 106 DRV_LOG(ERR, "port %u VLAN stripping, invalid queue number %d", 107 dev->data->port_id, queue); 108 return; 109 } 110 DRV_LOG(DEBUG, "port %u set VLAN stripping offloads %d for port %uqueue %d", 111 dev->data->port_id, on, rxq->port_id, queue); 112 if (!rxq_ctrl->obj) { 113 /* Update related bits in RX queue. */ 114 rxq->vlan_strip = !!on; 115 return; 116 } 117 ret = priv->obj_ops.rxq_obj_modify_vlan_strip(rxq_ctrl->obj, on); 118 if (ret) { 119 DRV_LOG(ERR, "Port %u failed to modify object stripping mode:" 120 " %s", dev->data->port_id, strerror(rte_errno)); 121 return; 122 } 123 /* Update related bits in RX queue. */ 124 rxq->vlan_strip = !!on; 125 } 126 127 /** 128 * Callback to set/reset VLAN offloads for a port. 129 * 130 * @param dev 131 * Pointer to Ethernet device structure. 132 * @param mask 133 * VLAN offload bit mask. 134 * 135 * @return 136 * 0 on success, a negative errno value otherwise and rte_errno is set. 137 */ 138 int 139 mlx5_vlan_offload_set(struct rte_eth_dev *dev, int mask) 140 { 141 struct mlx5_priv *priv = dev->data->dev_private; 142 unsigned int i; 143 144 if (mask & ETH_VLAN_STRIP_MASK) { 145 int hw_vlan_strip = !!(dev->data->dev_conf.rxmode.offloads & 146 DEV_RX_OFFLOAD_VLAN_STRIP); 147 148 if (!priv->config.hw_vlan_strip) { 149 DRV_LOG(ERR, "port %u VLAN stripping is not supported", 150 dev->data->port_id); 151 return 0; 152 } 153 /* Run on every RX queue and set/reset VLAN stripping. */ 154 for (i = 0; (i != priv->rxqs_n); i++) 155 mlx5_vlan_strip_queue_set(dev, i, hw_vlan_strip); 156 } 157 return 0; 158 } 159