4 * Copyright 2015 6WIND S.A.
5 * Copyright 2015 Mellanox.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
11 * * Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * * Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in
15 * the documentation and/or other materials provided with the
17 * * Neither the name of 6WIND S.A. nor the names of its
18 * contributors may be used to endorse or promote products derived
19 * from this software without specific prior written permission.
21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
39 #include <rte_ethdev_driver.h>
40 #include <rte_common.h>
42 #include "mlx5_utils.h"
44 #include "mlx5_autoconf.h"
47 * DPDK callback to configure a VLAN filter.
50 * Pointer to Ethernet device structure.
57 * 0 on success, negative errno value on failure.
60 mlx5_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
62 struct priv *priv = dev->data->dev_private;
67 DEBUG("%p: %s VLAN filter ID %" PRIu16,
68 (void *)dev, (on ? "enable" : "disable"), vlan_id);
69 assert(priv->vlan_filter_n <= RTE_DIM(priv->vlan_filter));
70 for (i = 0; (i != priv->vlan_filter_n); ++i)
71 if (priv->vlan_filter[i] == vlan_id)
73 /* Check if there's room for another VLAN filter. */
74 if (i == RTE_DIM(priv->vlan_filter)) {
78 if (i < priv->vlan_filter_n) {
79 assert(priv->vlan_filter_n != 0);
80 /* Enabling an existing VLAN filter has no effect. */
83 /* Remove VLAN filter from list. */
84 --priv->vlan_filter_n;
85 memmove(&priv->vlan_filter[i],
86 &priv->vlan_filter[i + 1],
87 sizeof(priv->vlan_filter[i]) *
88 (priv->vlan_filter_n - i));
89 priv->vlan_filter[priv->vlan_filter_n] = 0;
91 assert(i == priv->vlan_filter_n);
92 /* Disabling an unknown VLAN filter has no effect. */
95 /* Add new VLAN filter. */
96 priv->vlan_filter[priv->vlan_filter_n] = vlan_id;
97 ++priv->vlan_filter_n;
99 if (dev->data->dev_started)
100 priv_dev_traffic_restart(priv, dev);
107 * Set/reset VLAN stripping for a specific queue.
110 * Pointer to private structure.
114 * Enable/disable VLAN stripping.
117 priv_vlan_strip_queue_set(struct priv *priv, uint16_t idx, int on)
119 struct mlx5_rxq_data *rxq = (*priv->rxqs)[idx];
120 struct mlx5_rxq_ctrl *rxq_ctrl =
121 container_of(rxq, struct mlx5_rxq_ctrl, rxq);
122 struct ibv_wq_attr mod;
123 uint16_t vlan_offloads =
124 (on ? IBV_WQ_FLAGS_CVLAN_STRIPPING : 0) |
128 DEBUG("set VLAN offloads 0x%x for port %d queue %d",
129 vlan_offloads, rxq->port_id, idx);
130 if (!rxq_ctrl->ibv) {
131 /* Update related bits in RX queue. */
132 rxq->vlan_strip = !!on;
135 mod = (struct ibv_wq_attr){
136 .attr_mask = IBV_WQ_ATTR_FLAGS,
137 .flags_mask = IBV_WQ_FLAGS_CVLAN_STRIPPING,
138 .flags = vlan_offloads,
141 err = ibv_modify_wq(rxq_ctrl->ibv->wq, &mod);
143 ERROR("%p: failed to modified stripping mode: %s",
144 (void *)priv, strerror(err));
148 /* Update related bits in RX queue. */
149 rxq->vlan_strip = !!on;
153 * Callback to set/reset VLAN stripping for a specific queue.
156 * Pointer to Ethernet device structure.
160 * Enable/disable VLAN stripping.
163 mlx5_vlan_strip_queue_set(struct rte_eth_dev *dev, uint16_t queue, int on)
165 struct priv *priv = dev->data->dev_private;
167 /* Validate hw support */
168 if (!priv->config.hw_vlan_strip) {
169 ERROR("VLAN stripping is not supported");
173 /* Validate queue number */
174 if (queue >= priv->rxqs_n) {
175 ERROR("VLAN stripping, invalid queue number %d", queue);
180 priv_vlan_strip_queue_set(priv, queue, on);
185 * Callback to set/reset VLAN offloads for a port.
188 * Pointer to Ethernet device structure.
190 * VLAN offload bit mask.
193 mlx5_vlan_offload_set(struct rte_eth_dev *dev, int mask)
195 struct priv *priv = dev->data->dev_private;
198 if (mask & ETH_VLAN_STRIP_MASK) {
199 int hw_vlan_strip = !!(dev->data->dev_conf.rxmode.offloads &
200 DEV_RX_OFFLOAD_VLAN_STRIP);
202 if (!priv->config.hw_vlan_strip) {
203 ERROR("VLAN stripping is not supported");
207 /* Run on every RX queue and set/reset VLAN stripping. */
209 for (i = 0; (i != priv->rxqs_n); i++)
210 priv_vlan_strip_queue_set(priv, i, hw_vlan_strip);