2 * Copyright (c) 2015, Mellanox Technologies. All rights reserved.
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
33 #include <linux/list.h>
35 #include <linux/ipv6.h>
36 #include <linux/tcp.h>
37 #include <linux/mlx5/fs.h>
41 static int mlx5e_add_l2_flow_rule(struct mlx5e_priv *priv,
42 struct mlx5e_l2_rule *ai, int type);
43 static void mlx5e_del_l2_flow_rule(struct mlx5e_priv *priv,
44 struct mlx5e_l2_rule *ai);
59 MLX5E_ACTION_NONE = 0,
64 struct mlx5e_l2_hash_node {
65 struct hlist_node hlist;
67 struct mlx5e_l2_rule ai;
71 static inline int mlx5e_hash_l2(u8 *addr)
76 static void mlx5e_add_l2_to_hash(struct hlist_head *hash, u8 *addr)
78 struct mlx5e_l2_hash_node *hn;
79 int ix = mlx5e_hash_l2(addr);
82 hlist_for_each_entry(hn, &hash[ix], hlist)
83 if (ether_addr_equal_64bits(hn->ai.addr, addr)) {
89 hn->action = MLX5E_ACTION_NONE;
93 hn = kzalloc(sizeof(*hn), GFP_ATOMIC);
97 ether_addr_copy(hn->ai.addr, addr);
98 hn->action = MLX5E_ACTION_ADD;
100 hlist_add_head(&hn->hlist, &hash[ix]);
103 static void mlx5e_del_l2_from_hash(struct mlx5e_l2_hash_node *hn)
105 hlist_del(&hn->hlist);
109 static int mlx5e_vport_context_update_vlans(struct mlx5e_priv *priv)
111 struct net_device *ndev = priv->netdev;
120 for_each_set_bit(vlan, priv->fs.vlan.active_cvlans, VLAN_N_VID)
123 max_list_size = 1 << MLX5_CAP_GEN(priv->mdev, log_max_vlan_list);
125 if (list_size > max_list_size) {
127 "netdev vlans list size (%d) > (%d) max vport list size, some vlans will be dropped\n",
128 list_size, max_list_size);
129 list_size = max_list_size;
132 vlans = kcalloc(list_size, sizeof(*vlans), GFP_KERNEL);
137 for_each_set_bit(vlan, priv->fs.vlan.active_cvlans, VLAN_N_VID) {
143 err = mlx5_modify_nic_vport_vlans(priv->mdev, vlans, list_size);
145 netdev_err(ndev, "Failed to modify vport vlans list err(%d)\n",
152 enum mlx5e_vlan_rule_type {
153 MLX5E_VLAN_RULE_TYPE_UNTAGGED,
154 MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID,
155 MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID,
156 MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID,
157 MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID,
160 static int __mlx5e_add_vlan_rule(struct mlx5e_priv *priv,
161 enum mlx5e_vlan_rule_type rule_type,
162 u16 vid, struct mlx5_flow_spec *spec)
164 struct mlx5_flow_table *ft = priv->fs.vlan.ft.t;
165 struct mlx5_flow_destination dest = {};
166 struct mlx5_flow_handle **rule_p;
167 MLX5_DECLARE_FLOW_ACT(flow_act);
170 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
171 dest.ft = priv->fs.l2.ft.t;
173 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
176 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
177 /* cvlan_tag enabled in match criteria and
178 * disabled in match value means both S & C tags
179 * don't exist (untagged of both)
181 rule_p = &priv->fs.vlan.untagged_rule;
182 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
183 outer_headers.cvlan_tag);
185 case MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID:
186 rule_p = &priv->fs.vlan.any_cvlan_rule;
187 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
188 outer_headers.cvlan_tag);
189 MLX5_SET(fte_match_param, spec->match_value, outer_headers.cvlan_tag, 1);
191 case MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID:
192 rule_p = &priv->fs.vlan.any_svlan_rule;
193 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
194 outer_headers.svlan_tag);
195 MLX5_SET(fte_match_param, spec->match_value, outer_headers.svlan_tag, 1);
197 case MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID:
198 rule_p = &priv->fs.vlan.active_svlans_rule[vid];
199 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
200 outer_headers.svlan_tag);
201 MLX5_SET(fte_match_param, spec->match_value, outer_headers.svlan_tag, 1);
202 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
203 outer_headers.first_vid);
204 MLX5_SET(fte_match_param, spec->match_value, outer_headers.first_vid,
207 default: /* MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID */
208 rule_p = &priv->fs.vlan.active_cvlans_rule[vid];
209 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
210 outer_headers.cvlan_tag);
211 MLX5_SET(fte_match_param, spec->match_value, outer_headers.cvlan_tag, 1);
212 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
213 outer_headers.first_vid);
214 MLX5_SET(fte_match_param, spec->match_value, outer_headers.first_vid,
219 if (WARN_ONCE(*rule_p, "VLAN rule already exists type %d", rule_type))
222 *rule_p = mlx5_add_flow_rules(ft, spec, &flow_act, &dest, 1);
224 if (IS_ERR(*rule_p)) {
225 err = PTR_ERR(*rule_p);
227 netdev_err(priv->netdev, "%s: add rule failed\n", __func__);
233 static int mlx5e_add_vlan_rule(struct mlx5e_priv *priv,
234 enum mlx5e_vlan_rule_type rule_type, u16 vid)
236 struct mlx5_flow_spec *spec;
239 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
243 if (rule_type == MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID)
244 mlx5e_vport_context_update_vlans(priv);
246 err = __mlx5e_add_vlan_rule(priv, rule_type, vid, spec);
253 static void mlx5e_del_vlan_rule(struct mlx5e_priv *priv,
254 enum mlx5e_vlan_rule_type rule_type, u16 vid)
257 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
258 if (priv->fs.vlan.untagged_rule) {
259 mlx5_del_flow_rules(priv->fs.vlan.untagged_rule);
260 priv->fs.vlan.untagged_rule = NULL;
263 case MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID:
264 if (priv->fs.vlan.any_cvlan_rule) {
265 mlx5_del_flow_rules(priv->fs.vlan.any_cvlan_rule);
266 priv->fs.vlan.any_cvlan_rule = NULL;
269 case MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID:
270 if (priv->fs.vlan.any_svlan_rule) {
271 mlx5_del_flow_rules(priv->fs.vlan.any_svlan_rule);
272 priv->fs.vlan.any_svlan_rule = NULL;
275 case MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID:
276 if (priv->fs.vlan.active_svlans_rule[vid]) {
277 mlx5_del_flow_rules(priv->fs.vlan.active_svlans_rule[vid]);
278 priv->fs.vlan.active_svlans_rule[vid] = NULL;
281 case MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID:
282 if (priv->fs.vlan.active_cvlans_rule[vid]) {
283 mlx5_del_flow_rules(priv->fs.vlan.active_cvlans_rule[vid]);
284 priv->fs.vlan.active_cvlans_rule[vid] = NULL;
286 mlx5e_vport_context_update_vlans(priv);
291 static void mlx5e_del_any_vid_rules(struct mlx5e_priv *priv)
293 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, 0);
294 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID, 0);
297 static int mlx5e_add_any_vid_rules(struct mlx5e_priv *priv)
301 err = mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, 0);
305 return mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID, 0);
308 static struct mlx5_flow_handle *
309 mlx5e_add_trap_rule(struct mlx5_flow_table *ft, int trap_id, int tir_num)
311 struct mlx5_flow_destination dest = {};
312 MLX5_DECLARE_FLOW_ACT(flow_act);
313 struct mlx5_flow_handle *rule;
314 struct mlx5_flow_spec *spec;
316 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
318 return ERR_PTR(-ENOMEM);
319 spec->flow_context.flags |= FLOW_CONTEXT_HAS_TAG;
320 spec->flow_context.flow_tag = trap_id;
321 dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
322 dest.tir_num = tir_num;
324 rule = mlx5_add_flow_rules(ft, spec, &flow_act, &dest, 1);
329 int mlx5e_add_vlan_trap(struct mlx5e_priv *priv, int trap_id, int tir_num)
331 struct mlx5_flow_table *ft = priv->fs.vlan.ft.t;
332 struct mlx5_flow_handle *rule;
335 rule = mlx5e_add_trap_rule(ft, trap_id, tir_num);
338 priv->fs.vlan.trap_rule = NULL;
339 netdev_err(priv->netdev, "%s: add VLAN trap rule failed, err %d\n",
343 priv->fs.vlan.trap_rule = rule;
347 void mlx5e_remove_vlan_trap(struct mlx5e_priv *priv)
349 if (priv->fs.vlan.trap_rule) {
350 mlx5_del_flow_rules(priv->fs.vlan.trap_rule);
351 priv->fs.vlan.trap_rule = NULL;
355 int mlx5e_add_mac_trap(struct mlx5e_priv *priv, int trap_id, int tir_num)
357 struct mlx5_flow_table *ft = priv->fs.l2.ft.t;
358 struct mlx5_flow_handle *rule;
361 rule = mlx5e_add_trap_rule(ft, trap_id, tir_num);
364 priv->fs.l2.trap_rule = NULL;
365 netdev_err(priv->netdev, "%s: add MAC trap rule failed, err %d\n",
369 priv->fs.l2.trap_rule = rule;
373 void mlx5e_remove_mac_trap(struct mlx5e_priv *priv)
375 if (priv->fs.l2.trap_rule) {
376 mlx5_del_flow_rules(priv->fs.l2.trap_rule);
377 priv->fs.l2.trap_rule = NULL;
381 void mlx5e_enable_cvlan_filter(struct mlx5e_priv *priv)
383 if (!priv->fs.vlan.cvlan_filter_disabled)
386 priv->fs.vlan.cvlan_filter_disabled = false;
387 if (priv->netdev->flags & IFF_PROMISC)
389 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, 0);
392 void mlx5e_disable_cvlan_filter(struct mlx5e_priv *priv)
394 if (priv->fs.vlan.cvlan_filter_disabled)
397 priv->fs.vlan.cvlan_filter_disabled = true;
398 if (priv->netdev->flags & IFF_PROMISC)
400 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, 0);
403 static int mlx5e_vlan_rx_add_cvid(struct mlx5e_priv *priv, u16 vid)
407 set_bit(vid, priv->fs.vlan.active_cvlans);
409 err = mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid);
411 clear_bit(vid, priv->fs.vlan.active_cvlans);
416 static int mlx5e_vlan_rx_add_svid(struct mlx5e_priv *priv, u16 vid)
418 struct net_device *netdev = priv->netdev;
421 set_bit(vid, priv->fs.vlan.active_svlans);
423 err = mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid);
425 clear_bit(vid, priv->fs.vlan.active_svlans);
429 /* Need to fix some features.. */
430 netdev_update_features(netdev);
434 int mlx5e_vlan_rx_add_vid(struct net_device *dev, __be16 proto, u16 vid)
436 struct mlx5e_priv *priv = netdev_priv(dev);
438 if (be16_to_cpu(proto) == ETH_P_8021Q)
439 return mlx5e_vlan_rx_add_cvid(priv, vid);
440 else if (be16_to_cpu(proto) == ETH_P_8021AD)
441 return mlx5e_vlan_rx_add_svid(priv, vid);
446 int mlx5e_vlan_rx_kill_vid(struct net_device *dev, __be16 proto, u16 vid)
448 struct mlx5e_priv *priv = netdev_priv(dev);
450 if (be16_to_cpu(proto) == ETH_P_8021Q) {
451 clear_bit(vid, priv->fs.vlan.active_cvlans);
452 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid);
453 } else if (be16_to_cpu(proto) == ETH_P_8021AD) {
454 clear_bit(vid, priv->fs.vlan.active_svlans);
455 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid);
456 netdev_update_features(dev);
462 static void mlx5e_add_vlan_rules(struct mlx5e_priv *priv)
466 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_UNTAGGED, 0);
468 for_each_set_bit(i, priv->fs.vlan.active_cvlans, VLAN_N_VID) {
469 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, i);
472 for_each_set_bit(i, priv->fs.vlan.active_svlans, VLAN_N_VID)
473 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, i);
475 if (priv->fs.vlan.cvlan_filter_disabled)
476 mlx5e_add_any_vid_rules(priv);
479 static void mlx5e_del_vlan_rules(struct mlx5e_priv *priv)
483 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_UNTAGGED, 0);
485 for_each_set_bit(i, priv->fs.vlan.active_cvlans, VLAN_N_VID) {
486 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, i);
489 for_each_set_bit(i, priv->fs.vlan.active_svlans, VLAN_N_VID)
490 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, i);
492 WARN_ON_ONCE(!(test_bit(MLX5E_STATE_DESTROYING, &priv->state)));
494 mlx5e_remove_vlan_trap(priv);
496 /* must be called after DESTROY bit is set and
497 * set_rx_mode is called and flushed
499 if (priv->fs.vlan.cvlan_filter_disabled)
500 mlx5e_del_any_vid_rules(priv);
503 #define mlx5e_for_each_hash_node(hn, tmp, hash, i) \
504 for (i = 0; i < MLX5E_L2_ADDR_HASH_SIZE; i++) \
505 hlist_for_each_entry_safe(hn, tmp, &hash[i], hlist)
507 static void mlx5e_execute_l2_action(struct mlx5e_priv *priv,
508 struct mlx5e_l2_hash_node *hn)
510 u8 action = hn->action;
511 u8 mac_addr[ETH_ALEN];
514 ether_addr_copy(mac_addr, hn->ai.addr);
517 case MLX5E_ACTION_ADD:
518 mlx5e_add_l2_flow_rule(priv, &hn->ai, MLX5E_FULLMATCH);
519 if (!is_multicast_ether_addr(mac_addr)) {
520 l2_err = mlx5_mpfs_add_mac(priv->mdev, mac_addr);
523 hn->action = MLX5E_ACTION_NONE;
526 case MLX5E_ACTION_DEL:
527 if (!is_multicast_ether_addr(mac_addr) && hn->mpfs)
528 l2_err = mlx5_mpfs_del_mac(priv->mdev, mac_addr);
529 mlx5e_del_l2_flow_rule(priv, &hn->ai);
530 mlx5e_del_l2_from_hash(hn);
535 netdev_warn(priv->netdev, "MPFS, failed to %s mac %pM, err(%d)\n",
536 action == MLX5E_ACTION_ADD ? "add" : "del", mac_addr, l2_err);
539 static void mlx5e_sync_netdev_addr(struct mlx5e_priv *priv)
541 struct net_device *netdev = priv->netdev;
542 struct netdev_hw_addr *ha;
544 netif_addr_lock_bh(netdev);
546 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_uc,
547 priv->netdev->dev_addr);
549 netdev_for_each_uc_addr(ha, netdev)
550 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_uc, ha->addr);
552 netdev_for_each_mc_addr(ha, netdev)
553 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_mc, ha->addr);
555 netif_addr_unlock_bh(netdev);
558 static void mlx5e_fill_addr_array(struct mlx5e_priv *priv, int list_type,
559 u8 addr_array[][ETH_ALEN], int size)
561 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
562 struct net_device *ndev = priv->netdev;
563 struct mlx5e_l2_hash_node *hn;
564 struct hlist_head *addr_list;
565 struct hlist_node *tmp;
569 addr_list = is_uc ? priv->fs.l2.netdev_uc : priv->fs.l2.netdev_mc;
571 if (is_uc) /* Make sure our own address is pushed first */
572 ether_addr_copy(addr_array[i++], ndev->dev_addr);
573 else if (priv->fs.l2.broadcast_enabled)
574 ether_addr_copy(addr_array[i++], ndev->broadcast);
576 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi) {
577 if (ether_addr_equal(ndev->dev_addr, hn->ai.addr))
581 ether_addr_copy(addr_array[i++], hn->ai.addr);
585 static void mlx5e_vport_context_update_addr_list(struct mlx5e_priv *priv,
588 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
589 struct mlx5e_l2_hash_node *hn;
590 u8 (*addr_array)[ETH_ALEN] = NULL;
591 struct hlist_head *addr_list;
592 struct hlist_node *tmp;
598 size = is_uc ? 0 : (priv->fs.l2.broadcast_enabled ? 1 : 0);
600 1 << MLX5_CAP_GEN(priv->mdev, log_max_current_uc_list) :
601 1 << MLX5_CAP_GEN(priv->mdev, log_max_current_mc_list);
603 addr_list = is_uc ? priv->fs.l2.netdev_uc : priv->fs.l2.netdev_mc;
604 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi)
607 if (size > max_size) {
608 netdev_warn(priv->netdev,
609 "netdev %s list size (%d) > (%d) max vport list size, some addresses will be dropped\n",
610 is_uc ? "UC" : "MC", size, max_size);
615 addr_array = kcalloc(size, ETH_ALEN, GFP_KERNEL);
620 mlx5e_fill_addr_array(priv, list_type, addr_array, size);
623 err = mlx5_modify_nic_vport_mac_list(priv->mdev, list_type, addr_array, size);
626 netdev_err(priv->netdev,
627 "Failed to modify vport %s list err(%d)\n",
628 is_uc ? "UC" : "MC", err);
632 static void mlx5e_vport_context_update(struct mlx5e_priv *priv)
634 struct mlx5e_l2_table *ea = &priv->fs.l2;
636 mlx5e_vport_context_update_addr_list(priv, MLX5_NVPRT_LIST_TYPE_UC);
637 mlx5e_vport_context_update_addr_list(priv, MLX5_NVPRT_LIST_TYPE_MC);
638 mlx5_modify_nic_vport_promisc(priv->mdev, 0,
639 ea->allmulti_enabled,
640 ea->promisc_enabled);
643 static void mlx5e_apply_netdev_addr(struct mlx5e_priv *priv)
645 struct mlx5e_l2_hash_node *hn;
646 struct hlist_node *tmp;
649 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_uc, i)
650 mlx5e_execute_l2_action(priv, hn);
652 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_mc, i)
653 mlx5e_execute_l2_action(priv, hn);
656 static void mlx5e_handle_netdev_addr(struct mlx5e_priv *priv)
658 struct mlx5e_l2_hash_node *hn;
659 struct hlist_node *tmp;
662 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_uc, i)
663 hn->action = MLX5E_ACTION_DEL;
664 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_mc, i)
665 hn->action = MLX5E_ACTION_DEL;
667 if (!test_bit(MLX5E_STATE_DESTROYING, &priv->state))
668 mlx5e_sync_netdev_addr(priv);
670 mlx5e_apply_netdev_addr(priv);
673 #define MLX5E_PROMISC_GROUP0_SIZE BIT(0)
674 #define MLX5E_PROMISC_TABLE_SIZE MLX5E_PROMISC_GROUP0_SIZE
676 static int mlx5e_add_promisc_rule(struct mlx5e_priv *priv)
678 struct mlx5_flow_table *ft = priv->fs.promisc.ft.t;
679 struct mlx5_flow_destination dest = {};
680 struct mlx5_flow_handle **rule_p;
681 MLX5_DECLARE_FLOW_ACT(flow_act);
682 struct mlx5_flow_spec *spec;
685 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
688 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
689 dest.ft = priv->fs.ttc.ft.t;
691 rule_p = &priv->fs.promisc.rule;
692 *rule_p = mlx5_add_flow_rules(ft, spec, &flow_act, &dest, 1);
693 if (IS_ERR(*rule_p)) {
694 err = PTR_ERR(*rule_p);
696 netdev_err(priv->netdev, "%s: add promiscuous rule failed\n", __func__);
702 static int mlx5e_create_promisc_table(struct mlx5e_priv *priv)
704 struct mlx5e_flow_table *ft = &priv->fs.promisc.ft;
705 struct mlx5_flow_table_attr ft_attr = {};
708 ft_attr.max_fte = MLX5E_PROMISC_TABLE_SIZE;
709 ft_attr.autogroup.max_num_groups = 1;
710 ft_attr.level = MLX5E_PROMISC_FT_LEVEL;
711 ft_attr.prio = MLX5E_NIC_PRIO;
713 ft->t = mlx5_create_auto_grouped_flow_table(priv->fs.ns, &ft_attr);
715 err = PTR_ERR(ft->t);
716 netdev_err(priv->netdev, "fail to create promisc table err=%d\n", err);
720 err = mlx5e_add_promisc_rule(priv);
722 goto err_destroy_promisc_table;
726 err_destroy_promisc_table:
727 mlx5_destroy_flow_table(ft->t);
733 static void mlx5e_del_promisc_rule(struct mlx5e_priv *priv)
735 if (WARN(!priv->fs.promisc.rule, "Trying to remove non-existing promiscuous rule"))
737 mlx5_del_flow_rules(priv->fs.promisc.rule);
738 priv->fs.promisc.rule = NULL;
741 static void mlx5e_destroy_promisc_table(struct mlx5e_priv *priv)
743 if (WARN(!priv->fs.promisc.ft.t, "Trying to remove non-existing promiscuous table"))
745 mlx5e_del_promisc_rule(priv);
746 mlx5_destroy_flow_table(priv->fs.promisc.ft.t);
747 priv->fs.promisc.ft.t = NULL;
750 void mlx5e_set_rx_mode_work(struct work_struct *work)
752 struct mlx5e_priv *priv = container_of(work, struct mlx5e_priv,
755 struct mlx5e_l2_table *ea = &priv->fs.l2;
756 struct net_device *ndev = priv->netdev;
758 bool rx_mode_enable = !test_bit(MLX5E_STATE_DESTROYING, &priv->state);
759 bool promisc_enabled = rx_mode_enable && (ndev->flags & IFF_PROMISC);
760 bool allmulti_enabled = rx_mode_enable && (ndev->flags & IFF_ALLMULTI);
761 bool broadcast_enabled = rx_mode_enable;
763 bool enable_promisc = !ea->promisc_enabled && promisc_enabled;
764 bool disable_promisc = ea->promisc_enabled && !promisc_enabled;
765 bool enable_allmulti = !ea->allmulti_enabled && allmulti_enabled;
766 bool disable_allmulti = ea->allmulti_enabled && !allmulti_enabled;
767 bool enable_broadcast = !ea->broadcast_enabled && broadcast_enabled;
768 bool disable_broadcast = ea->broadcast_enabled && !broadcast_enabled;
771 if (enable_promisc) {
772 err = mlx5e_create_promisc_table(priv);
774 enable_promisc = false;
775 if (!priv->channels.params.vlan_strip_disable && !err)
776 netdev_warn_once(ndev,
777 "S-tagged traffic will be dropped while C-tag vlan stripping is enabled\n");
780 mlx5e_add_l2_flow_rule(priv, &ea->allmulti, MLX5E_ALLMULTI);
781 if (enable_broadcast)
782 mlx5e_add_l2_flow_rule(priv, &ea->broadcast, MLX5E_FULLMATCH);
784 mlx5e_handle_netdev_addr(priv);
786 if (disable_broadcast)
787 mlx5e_del_l2_flow_rule(priv, &ea->broadcast);
788 if (disable_allmulti)
789 mlx5e_del_l2_flow_rule(priv, &ea->allmulti);
791 mlx5e_destroy_promisc_table(priv);
793 ea->promisc_enabled = promisc_enabled;
794 ea->allmulti_enabled = allmulti_enabled;
795 ea->broadcast_enabled = broadcast_enabled;
797 mlx5e_vport_context_update(priv);
800 static void mlx5e_destroy_groups(struct mlx5e_flow_table *ft)
804 for (i = ft->num_groups - 1; i >= 0; i--) {
805 if (!IS_ERR_OR_NULL(ft->g[i]))
806 mlx5_destroy_flow_group(ft->g[i]);
812 void mlx5e_init_l2_addr(struct mlx5e_priv *priv)
814 ether_addr_copy(priv->fs.l2.broadcast.addr, priv->netdev->broadcast);
817 void mlx5e_destroy_flow_table(struct mlx5e_flow_table *ft)
819 mlx5e_destroy_groups(ft);
821 mlx5_destroy_flow_table(ft->t);
825 static void mlx5e_cleanup_ttc_rules(struct mlx5e_ttc_table *ttc)
829 for (i = 0; i < MLX5E_NUM_TT; i++) {
830 if (!IS_ERR_OR_NULL(ttc->rules[i].rule)) {
831 mlx5_del_flow_rules(ttc->rules[i].rule);
832 ttc->rules[i].rule = NULL;
836 for (i = 0; i < MLX5E_NUM_TUNNEL_TT; i++) {
837 if (!IS_ERR_OR_NULL(ttc->tunnel_rules[i])) {
838 mlx5_del_flow_rules(ttc->tunnel_rules[i]);
839 ttc->tunnel_rules[i] = NULL;
844 struct mlx5e_etype_proto {
849 static struct mlx5e_etype_proto ttc_rules[] = {
850 [MLX5E_TT_IPV4_TCP] = {
852 .proto = IPPROTO_TCP,
854 [MLX5E_TT_IPV6_TCP] = {
856 .proto = IPPROTO_TCP,
858 [MLX5E_TT_IPV4_UDP] = {
860 .proto = IPPROTO_UDP,
862 [MLX5E_TT_IPV6_UDP] = {
864 .proto = IPPROTO_UDP,
866 [MLX5E_TT_IPV4_IPSEC_AH] = {
870 [MLX5E_TT_IPV6_IPSEC_AH] = {
874 [MLX5E_TT_IPV4_IPSEC_ESP] = {
876 .proto = IPPROTO_ESP,
878 [MLX5E_TT_IPV6_IPSEC_ESP] = {
880 .proto = IPPROTO_ESP,
896 static struct mlx5e_etype_proto ttc_tunnel_rules[] = {
897 [MLX5E_TT_IPV4_GRE] = {
899 .proto = IPPROTO_GRE,
901 [MLX5E_TT_IPV6_GRE] = {
903 .proto = IPPROTO_GRE,
905 [MLX5E_TT_IPV4_IPIP] = {
907 .proto = IPPROTO_IPIP,
909 [MLX5E_TT_IPV6_IPIP] = {
911 .proto = IPPROTO_IPIP,
913 [MLX5E_TT_IPV4_IPV6] = {
915 .proto = IPPROTO_IPV6,
917 [MLX5E_TT_IPV6_IPV6] = {
919 .proto = IPPROTO_IPV6,
924 u8 mlx5e_get_proto_by_tunnel_type(enum mlx5e_tunnel_types tt)
926 return ttc_tunnel_rules[tt].proto;
929 static bool mlx5e_tunnel_proto_supported_rx(struct mlx5_core_dev *mdev, u8 proto_type)
931 switch (proto_type) {
933 return MLX5_CAP_ETH(mdev, tunnel_stateless_gre);
936 return (MLX5_CAP_ETH(mdev, tunnel_stateless_ip_over_ip) ||
937 MLX5_CAP_ETH(mdev, tunnel_stateless_ip_over_ip_rx));
943 static bool mlx5e_tunnel_any_rx_proto_supported(struct mlx5_core_dev *mdev)
947 for (tt = 0; tt < MLX5E_NUM_TUNNEL_TT; tt++) {
948 if (mlx5e_tunnel_proto_supported_rx(mdev, ttc_tunnel_rules[tt].proto))
954 bool mlx5e_tunnel_inner_ft_supported(struct mlx5_core_dev *mdev)
956 return (mlx5e_tunnel_any_rx_proto_supported(mdev) &&
957 MLX5_CAP_FLOWTABLE_NIC_RX(mdev, ft_field_support.inner_ip_version));
960 static u8 mlx5e_etype_to_ipv(u16 ethertype)
962 if (ethertype == ETH_P_IP)
965 if (ethertype == ETH_P_IPV6)
971 static struct mlx5_flow_handle *
972 mlx5e_generate_ttc_rule(struct mlx5e_priv *priv,
973 struct mlx5_flow_table *ft,
974 struct mlx5_flow_destination *dest,
978 int match_ipv_outer = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, ft_field_support.outer_ip_version);
979 MLX5_DECLARE_FLOW_ACT(flow_act);
980 struct mlx5_flow_handle *rule;
981 struct mlx5_flow_spec *spec;
985 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
987 return ERR_PTR(-ENOMEM);
990 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
991 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.ip_protocol);
992 MLX5_SET(fte_match_param, spec->match_value, outer_headers.ip_protocol, proto);
995 ipv = mlx5e_etype_to_ipv(etype);
996 if (match_ipv_outer && ipv) {
997 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
998 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.ip_version);
999 MLX5_SET(fte_match_param, spec->match_value, outer_headers.ip_version, ipv);
1001 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1002 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, outer_headers.ethertype);
1003 MLX5_SET(fte_match_param, spec->match_value, outer_headers.ethertype, etype);
1006 rule = mlx5_add_flow_rules(ft, spec, &flow_act, dest, 1);
1008 err = PTR_ERR(rule);
1009 netdev_err(priv->netdev, "%s: add rule failed\n", __func__);
1013 return err ? ERR_PTR(err) : rule;
1016 static int mlx5e_generate_ttc_table_rules(struct mlx5e_priv *priv,
1017 struct ttc_params *params,
1018 struct mlx5e_ttc_table *ttc)
1020 struct mlx5_flow_destination dest = {};
1021 struct mlx5_flow_handle **trules;
1022 struct mlx5e_ttc_rule *rules;
1023 struct mlx5_flow_table *ft;
1030 dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
1031 for (tt = 0; tt < MLX5E_NUM_TT; tt++) {
1032 struct mlx5e_ttc_rule *rule = &rules[tt];
1034 if (tt == MLX5E_TT_ANY)
1035 dest.tir_num = params->any_tt_tirn;
1037 dest.tir_num = params->indir_tirn[tt];
1039 rule->rule = mlx5e_generate_ttc_rule(priv, ft, &dest,
1040 ttc_rules[tt].etype,
1041 ttc_rules[tt].proto);
1042 if (IS_ERR(rule->rule)) {
1043 err = PTR_ERR(rule->rule);
1047 rule->default_dest = dest;
1050 if (!params->inner_ttc || !mlx5e_tunnel_inner_ft_supported(priv->mdev))
1053 trules = ttc->tunnel_rules;
1054 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
1055 dest.ft = params->inner_ttc->ft.t;
1056 for (tt = 0; tt < MLX5E_NUM_TUNNEL_TT; tt++) {
1057 if (!mlx5e_tunnel_proto_supported_rx(priv->mdev,
1058 ttc_tunnel_rules[tt].proto))
1060 trules[tt] = mlx5e_generate_ttc_rule(priv, ft, &dest,
1061 ttc_tunnel_rules[tt].etype,
1062 ttc_tunnel_rules[tt].proto);
1063 if (IS_ERR(trules[tt])) {
1064 err = PTR_ERR(trules[tt]);
1073 mlx5e_cleanup_ttc_rules(ttc);
1077 static int mlx5e_create_ttc_table_groups(struct mlx5e_ttc_table *ttc,
1080 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1081 struct mlx5e_flow_table *ft = &ttc->ft;
1087 ft->g = kcalloc(MLX5E_TTC_NUM_GROUPS,
1088 sizeof(*ft->g), GFP_KERNEL);
1091 in = kvzalloc(inlen, GFP_KERNEL);
1099 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1100 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.ip_protocol);
1102 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.ip_version);
1104 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.ethertype);
1105 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1106 MLX5_SET_CFG(in, start_flow_index, ix);
1107 ix += MLX5E_TTC_GROUP1_SIZE;
1108 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1109 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1110 if (IS_ERR(ft->g[ft->num_groups]))
1115 MLX5_SET(fte_match_param, mc, outer_headers.ip_protocol, 0);
1116 MLX5_SET_CFG(in, start_flow_index, ix);
1117 ix += MLX5E_TTC_GROUP2_SIZE;
1118 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1119 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1120 if (IS_ERR(ft->g[ft->num_groups]))
1125 memset(in, 0, inlen);
1126 MLX5_SET_CFG(in, start_flow_index, ix);
1127 ix += MLX5E_TTC_GROUP3_SIZE;
1128 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1129 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1130 if (IS_ERR(ft->g[ft->num_groups]))
1138 err = PTR_ERR(ft->g[ft->num_groups]);
1139 ft->g[ft->num_groups] = NULL;
1145 static struct mlx5_flow_handle *
1146 mlx5e_generate_inner_ttc_rule(struct mlx5e_priv *priv,
1147 struct mlx5_flow_table *ft,
1148 struct mlx5_flow_destination *dest,
1149 u16 etype, u8 proto)
1151 MLX5_DECLARE_FLOW_ACT(flow_act);
1152 struct mlx5_flow_handle *rule;
1153 struct mlx5_flow_spec *spec;
1157 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1159 return ERR_PTR(-ENOMEM);
1161 ipv = mlx5e_etype_to_ipv(etype);
1163 spec->match_criteria_enable = MLX5_MATCH_INNER_HEADERS;
1164 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, inner_headers.ip_version);
1165 MLX5_SET(fte_match_param, spec->match_value, inner_headers.ip_version, ipv);
1169 spec->match_criteria_enable = MLX5_MATCH_INNER_HEADERS;
1170 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria, inner_headers.ip_protocol);
1171 MLX5_SET(fte_match_param, spec->match_value, inner_headers.ip_protocol, proto);
1174 rule = mlx5_add_flow_rules(ft, spec, &flow_act, dest, 1);
1176 err = PTR_ERR(rule);
1177 netdev_err(priv->netdev, "%s: add rule failed\n", __func__);
1181 return err ? ERR_PTR(err) : rule;
1184 static int mlx5e_generate_inner_ttc_table_rules(struct mlx5e_priv *priv,
1185 struct ttc_params *params,
1186 struct mlx5e_ttc_table *ttc)
1188 struct mlx5_flow_destination dest = {};
1189 struct mlx5e_ttc_rule *rules;
1190 struct mlx5_flow_table *ft;
1196 dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
1198 for (tt = 0; tt < MLX5E_NUM_TT; tt++) {
1199 struct mlx5e_ttc_rule *rule = &rules[tt];
1201 if (tt == MLX5E_TT_ANY)
1202 dest.tir_num = params->any_tt_tirn;
1204 dest.tir_num = params->indir_tirn[tt];
1206 rule->rule = mlx5e_generate_inner_ttc_rule(priv, ft, &dest,
1207 ttc_rules[tt].etype,
1208 ttc_rules[tt].proto);
1209 if (IS_ERR(rule->rule)) {
1210 err = PTR_ERR(rule->rule);
1214 rule->default_dest = dest;
1221 mlx5e_cleanup_ttc_rules(ttc);
1225 static int mlx5e_create_inner_ttc_table_groups(struct mlx5e_ttc_table *ttc)
1227 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1228 struct mlx5e_flow_table *ft = &ttc->ft;
1234 ft->g = kcalloc(MLX5E_INNER_TTC_NUM_GROUPS, sizeof(*ft->g), GFP_KERNEL);
1237 in = kvzalloc(inlen, GFP_KERNEL);
1245 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1246 MLX5_SET_TO_ONES(fte_match_param, mc, inner_headers.ip_protocol);
1247 MLX5_SET_TO_ONES(fte_match_param, mc, inner_headers.ip_version);
1248 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_INNER_HEADERS);
1249 MLX5_SET_CFG(in, start_flow_index, ix);
1250 ix += MLX5E_INNER_TTC_GROUP1_SIZE;
1251 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1252 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1253 if (IS_ERR(ft->g[ft->num_groups]))
1258 MLX5_SET(fte_match_param, mc, inner_headers.ip_protocol, 0);
1259 MLX5_SET_CFG(in, start_flow_index, ix);
1260 ix += MLX5E_INNER_TTC_GROUP2_SIZE;
1261 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1262 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1263 if (IS_ERR(ft->g[ft->num_groups]))
1268 memset(in, 0, inlen);
1269 MLX5_SET_CFG(in, start_flow_index, ix);
1270 ix += MLX5E_INNER_TTC_GROUP3_SIZE;
1271 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1272 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1273 if (IS_ERR(ft->g[ft->num_groups]))
1281 err = PTR_ERR(ft->g[ft->num_groups]);
1282 ft->g[ft->num_groups] = NULL;
1288 void mlx5e_set_ttc_basic_params(struct mlx5e_priv *priv,
1289 struct ttc_params *ttc_params)
1291 ttc_params->any_tt_tirn = priv->direct_tir[0].tirn;
1292 ttc_params->inner_ttc = &priv->fs.inner_ttc;
1295 void mlx5e_set_inner_ttc_ft_params(struct ttc_params *ttc_params)
1297 struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
1299 ft_attr->max_fte = MLX5E_INNER_TTC_TABLE_SIZE;
1300 ft_attr->level = MLX5E_INNER_TTC_FT_LEVEL;
1301 ft_attr->prio = MLX5E_NIC_PRIO;
1304 void mlx5e_set_ttc_ft_params(struct ttc_params *ttc_params)
1307 struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
1309 ft_attr->max_fte = MLX5E_TTC_TABLE_SIZE;
1310 ft_attr->level = MLX5E_TTC_FT_LEVEL;
1311 ft_attr->prio = MLX5E_NIC_PRIO;
1314 int mlx5e_create_inner_ttc_table(struct mlx5e_priv *priv, struct ttc_params *params,
1315 struct mlx5e_ttc_table *ttc)
1317 struct mlx5e_flow_table *ft = &ttc->ft;
1320 if (!mlx5e_tunnel_inner_ft_supported(priv->mdev))
1323 ft->t = mlx5_create_flow_table(priv->fs.ns, ¶ms->ft_attr);
1324 if (IS_ERR(ft->t)) {
1325 err = PTR_ERR(ft->t);
1330 err = mlx5e_create_inner_ttc_table_groups(ttc);
1334 err = mlx5e_generate_inner_ttc_table_rules(priv, params, ttc);
1341 mlx5e_destroy_flow_table(ft);
1345 void mlx5e_destroy_inner_ttc_table(struct mlx5e_priv *priv,
1346 struct mlx5e_ttc_table *ttc)
1348 if (!mlx5e_tunnel_inner_ft_supported(priv->mdev))
1351 mlx5e_cleanup_ttc_rules(ttc);
1352 mlx5e_destroy_flow_table(&ttc->ft);
1355 void mlx5e_destroy_ttc_table(struct mlx5e_priv *priv,
1356 struct mlx5e_ttc_table *ttc)
1358 mlx5e_cleanup_ttc_rules(ttc);
1359 mlx5e_destroy_flow_table(&ttc->ft);
1362 int mlx5e_create_ttc_table(struct mlx5e_priv *priv, struct ttc_params *params,
1363 struct mlx5e_ttc_table *ttc)
1365 bool match_ipv_outer = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, ft_field_support.outer_ip_version);
1366 struct mlx5e_flow_table *ft = &ttc->ft;
1369 ft->t = mlx5_create_flow_table(priv->fs.ns, ¶ms->ft_attr);
1370 if (IS_ERR(ft->t)) {
1371 err = PTR_ERR(ft->t);
1376 err = mlx5e_create_ttc_table_groups(ttc, match_ipv_outer);
1380 err = mlx5e_generate_ttc_table_rules(priv, params, ttc);
1386 mlx5e_destroy_flow_table(ft);
1390 int mlx5e_ttc_fwd_dest(struct mlx5e_priv *priv, enum mlx5e_traffic_types type,
1391 struct mlx5_flow_destination *new_dest)
1393 return mlx5_modify_rule_destination(priv->fs.ttc.rules[type].rule, new_dest, NULL);
1396 struct mlx5_flow_destination
1397 mlx5e_ttc_get_default_dest(struct mlx5e_priv *priv, enum mlx5e_traffic_types type)
1399 struct mlx5_flow_destination *dest = &priv->fs.ttc.rules[type].default_dest;
1401 WARN_ONCE(dest->type != MLX5_FLOW_DESTINATION_TYPE_TIR,
1402 "TTC[%d] default dest is not setup yet", type);
1407 int mlx5e_ttc_fwd_default_dest(struct mlx5e_priv *priv, enum mlx5e_traffic_types type)
1409 struct mlx5_flow_destination dest = mlx5e_ttc_get_default_dest(priv, type);
1411 return mlx5e_ttc_fwd_dest(priv, type, &dest);
1414 static void mlx5e_del_l2_flow_rule(struct mlx5e_priv *priv,
1415 struct mlx5e_l2_rule *ai)
1417 if (!IS_ERR_OR_NULL(ai->rule)) {
1418 mlx5_del_flow_rules(ai->rule);
1423 static int mlx5e_add_l2_flow_rule(struct mlx5e_priv *priv,
1424 struct mlx5e_l2_rule *ai, int type)
1426 struct mlx5_flow_table *ft = priv->fs.l2.ft.t;
1427 struct mlx5_flow_destination dest = {};
1428 MLX5_DECLARE_FLOW_ACT(flow_act);
1429 struct mlx5_flow_spec *spec;
1434 spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
1438 mc_dmac = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
1439 outer_headers.dmac_47_16);
1440 mv_dmac = MLX5_ADDR_OF(fte_match_param, spec->match_value,
1441 outer_headers.dmac_47_16);
1443 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
1444 dest.ft = priv->fs.ttc.ft.t;
1447 case MLX5E_FULLMATCH:
1448 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1449 eth_broadcast_addr(mc_dmac);
1450 ether_addr_copy(mv_dmac, ai->addr);
1453 case MLX5E_ALLMULTI:
1454 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
1460 ai->rule = mlx5_add_flow_rules(ft, spec, &flow_act, &dest, 1);
1461 if (IS_ERR(ai->rule)) {
1462 netdev_err(priv->netdev, "%s: add l2 rule(mac:%pM) failed\n",
1464 err = PTR_ERR(ai->rule);
1473 #define MLX5E_NUM_L2_GROUPS 3
1474 #define MLX5E_L2_GROUP1_SIZE BIT(15)
1475 #define MLX5E_L2_GROUP2_SIZE BIT(0)
1476 #define MLX5E_L2_GROUP_TRAP_SIZE BIT(0) /* must be last */
1477 #define MLX5E_L2_TABLE_SIZE (MLX5E_L2_GROUP1_SIZE +\
1478 MLX5E_L2_GROUP2_SIZE +\
1479 MLX5E_L2_GROUP_TRAP_SIZE)
1480 static int mlx5e_create_l2_table_groups(struct mlx5e_l2_table *l2_table)
1482 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1483 struct mlx5e_flow_table *ft = &l2_table->ft;
1490 ft->g = kcalloc(MLX5E_NUM_L2_GROUPS, sizeof(*ft->g), GFP_KERNEL);
1493 in = kvzalloc(inlen, GFP_KERNEL);
1499 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1500 mc_dmac = MLX5_ADDR_OF(fte_match_param, mc,
1501 outer_headers.dmac_47_16);
1502 /* Flow Group for full match */
1503 eth_broadcast_addr(mc_dmac);
1504 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1505 MLX5_SET_CFG(in, start_flow_index, ix);
1506 ix += MLX5E_L2_GROUP1_SIZE;
1507 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1508 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1509 if (IS_ERR(ft->g[ft->num_groups]))
1510 goto err_destroy_groups;
1513 /* Flow Group for allmulti */
1514 eth_zero_addr(mc_dmac);
1516 MLX5_SET_CFG(in, start_flow_index, ix);
1517 ix += MLX5E_L2_GROUP2_SIZE;
1518 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1519 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1520 if (IS_ERR(ft->g[ft->num_groups]))
1521 goto err_destroy_groups;
1524 /* Flow Group for l2 traps */
1525 memset(in, 0, inlen);
1526 MLX5_SET_CFG(in, start_flow_index, ix);
1527 ix += MLX5E_L2_GROUP_TRAP_SIZE;
1528 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1529 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1530 if (IS_ERR(ft->g[ft->num_groups]))
1531 goto err_destroy_groups;
1538 err = PTR_ERR(ft->g[ft->num_groups]);
1539 ft->g[ft->num_groups] = NULL;
1540 mlx5e_destroy_groups(ft);
1547 static void mlx5e_destroy_l2_table(struct mlx5e_priv *priv)
1549 mlx5e_destroy_flow_table(&priv->fs.l2.ft);
1552 static int mlx5e_create_l2_table(struct mlx5e_priv *priv)
1554 struct mlx5e_l2_table *l2_table = &priv->fs.l2;
1555 struct mlx5e_flow_table *ft = &l2_table->ft;
1556 struct mlx5_flow_table_attr ft_attr = {};
1561 ft_attr.max_fte = MLX5E_L2_TABLE_SIZE;
1562 ft_attr.level = MLX5E_L2_FT_LEVEL;
1563 ft_attr.prio = MLX5E_NIC_PRIO;
1565 ft->t = mlx5_create_flow_table(priv->fs.ns, &ft_attr);
1566 if (IS_ERR(ft->t)) {
1567 err = PTR_ERR(ft->t);
1572 err = mlx5e_create_l2_table_groups(l2_table);
1574 goto err_destroy_flow_table;
1578 err_destroy_flow_table:
1579 mlx5_destroy_flow_table(ft->t);
1585 #define MLX5E_NUM_VLAN_GROUPS 5
1586 #define MLX5E_VLAN_GROUP0_SIZE BIT(12)
1587 #define MLX5E_VLAN_GROUP1_SIZE BIT(12)
1588 #define MLX5E_VLAN_GROUP2_SIZE BIT(1)
1589 #define MLX5E_VLAN_GROUP3_SIZE BIT(0)
1590 #define MLX5E_VLAN_GROUP_TRAP_SIZE BIT(0) /* must be last */
1591 #define MLX5E_VLAN_TABLE_SIZE (MLX5E_VLAN_GROUP0_SIZE +\
1592 MLX5E_VLAN_GROUP1_SIZE +\
1593 MLX5E_VLAN_GROUP2_SIZE +\
1594 MLX5E_VLAN_GROUP3_SIZE +\
1595 MLX5E_VLAN_GROUP_TRAP_SIZE)
1597 static int __mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft, u32 *in,
1602 u8 *mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1604 memset(in, 0, inlen);
1605 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1606 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.cvlan_tag);
1607 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
1608 MLX5_SET_CFG(in, start_flow_index, ix);
1609 ix += MLX5E_VLAN_GROUP0_SIZE;
1610 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1611 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1612 if (IS_ERR(ft->g[ft->num_groups]))
1613 goto err_destroy_groups;
1616 memset(in, 0, inlen);
1617 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1618 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.svlan_tag);
1619 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
1620 MLX5_SET_CFG(in, start_flow_index, ix);
1621 ix += MLX5E_VLAN_GROUP1_SIZE;
1622 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1623 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1624 if (IS_ERR(ft->g[ft->num_groups]))
1625 goto err_destroy_groups;
1628 memset(in, 0, inlen);
1629 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1630 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.cvlan_tag);
1631 MLX5_SET_CFG(in, start_flow_index, ix);
1632 ix += MLX5E_VLAN_GROUP2_SIZE;
1633 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1634 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1635 if (IS_ERR(ft->g[ft->num_groups]))
1636 goto err_destroy_groups;
1639 memset(in, 0, inlen);
1640 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1641 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.svlan_tag);
1642 MLX5_SET_CFG(in, start_flow_index, ix);
1643 ix += MLX5E_VLAN_GROUP3_SIZE;
1644 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1645 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1646 if (IS_ERR(ft->g[ft->num_groups]))
1647 goto err_destroy_groups;
1650 memset(in, 0, inlen);
1651 MLX5_SET_CFG(in, start_flow_index, ix);
1652 ix += MLX5E_VLAN_GROUP_TRAP_SIZE;
1653 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1654 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
1655 if (IS_ERR(ft->g[ft->num_groups]))
1656 goto err_destroy_groups;
1662 err = PTR_ERR(ft->g[ft->num_groups]);
1663 ft->g[ft->num_groups] = NULL;
1664 mlx5e_destroy_groups(ft);
1669 static int mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft)
1672 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1675 in = kvzalloc(inlen, GFP_KERNEL);
1679 err = __mlx5e_create_vlan_table_groups(ft, in, inlen);
1685 static int mlx5e_create_vlan_table(struct mlx5e_priv *priv)
1687 struct mlx5e_flow_table *ft = &priv->fs.vlan.ft;
1688 struct mlx5_flow_table_attr ft_attr = {};
1693 ft_attr.max_fte = MLX5E_VLAN_TABLE_SIZE;
1694 ft_attr.level = MLX5E_VLAN_FT_LEVEL;
1695 ft_attr.prio = MLX5E_NIC_PRIO;
1697 ft->t = mlx5_create_flow_table(priv->fs.ns, &ft_attr);
1699 if (IS_ERR(ft->t)) {
1700 err = PTR_ERR(ft->t);
1704 ft->g = kcalloc(MLX5E_NUM_VLAN_GROUPS, sizeof(*ft->g), GFP_KERNEL);
1707 goto err_destroy_vlan_table;
1710 err = mlx5e_create_vlan_table_groups(ft);
1714 mlx5e_add_vlan_rules(priv);
1720 err_destroy_vlan_table:
1721 mlx5_destroy_flow_table(ft->t);
1727 static void mlx5e_destroy_vlan_table(struct mlx5e_priv *priv)
1729 mlx5e_del_vlan_rules(priv);
1730 mlx5e_destroy_flow_table(&priv->fs.vlan.ft);
1733 int mlx5e_create_flow_steering(struct mlx5e_priv *priv)
1735 struct ttc_params ttc_params = {};
1738 priv->fs.ns = mlx5_get_flow_namespace(priv->mdev,
1739 MLX5_FLOW_NAMESPACE_KERNEL);
1744 err = mlx5e_arfs_create_tables(priv);
1746 netdev_err(priv->netdev, "Failed to create arfs tables, err=%d\n",
1748 priv->netdev->hw_features &= ~NETIF_F_NTUPLE;
1751 mlx5e_set_ttc_basic_params(priv, &ttc_params);
1752 mlx5e_set_inner_ttc_ft_params(&ttc_params);
1753 for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
1754 ttc_params.indir_tirn[tt] = priv->inner_indir_tir[tt].tirn;
1756 err = mlx5e_create_inner_ttc_table(priv, &ttc_params, &priv->fs.inner_ttc);
1758 netdev_err(priv->netdev, "Failed to create inner ttc table, err=%d\n",
1760 goto err_destroy_arfs_tables;
1763 mlx5e_set_ttc_ft_params(&ttc_params);
1764 for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
1765 ttc_params.indir_tirn[tt] = priv->indir_tir[tt].tirn;
1767 err = mlx5e_create_ttc_table(priv, &ttc_params, &priv->fs.ttc);
1769 netdev_err(priv->netdev, "Failed to create ttc table, err=%d\n",
1771 goto err_destroy_inner_ttc_table;
1774 err = mlx5e_create_l2_table(priv);
1776 netdev_err(priv->netdev, "Failed to create l2 table, err=%d\n",
1778 goto err_destroy_ttc_table;
1781 err = mlx5e_create_vlan_table(priv);
1783 netdev_err(priv->netdev, "Failed to create vlan table, err=%d\n",
1785 goto err_destroy_l2_table;
1788 mlx5e_ethtool_init_steering(priv);
1792 err_destroy_l2_table:
1793 mlx5e_destroy_l2_table(priv);
1794 err_destroy_ttc_table:
1795 mlx5e_destroy_ttc_table(priv, &priv->fs.ttc);
1796 err_destroy_inner_ttc_table:
1797 mlx5e_destroy_inner_ttc_table(priv, &priv->fs.inner_ttc);
1798 err_destroy_arfs_tables:
1799 mlx5e_arfs_destroy_tables(priv);
1804 void mlx5e_destroy_flow_steering(struct mlx5e_priv *priv)
1806 mlx5e_destroy_vlan_table(priv);
1807 mlx5e_destroy_l2_table(priv);
1808 mlx5e_destroy_ttc_table(priv, &priv->fs.ttc);
1809 mlx5e_destroy_inner_ttc_table(priv, &priv->fs.inner_ttc);
1810 mlx5e_arfs_destroy_tables(priv);
1811 mlx5e_ethtool_cleanup_steering(priv);