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>
40 static int mlx5e_add_l2_flow_rule(struct mlx5e_priv *priv,
41 struct mlx5e_l2_rule *ai, int type);
42 static void mlx5e_del_l2_flow_rule(struct mlx5e_priv *priv,
43 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;
70 static inline int mlx5e_hash_l2(u8 *addr)
75 static void mlx5e_add_l2_to_hash(struct hlist_head *hash, u8 *addr)
77 struct mlx5e_l2_hash_node *hn;
78 int ix = mlx5e_hash_l2(addr);
81 hlist_for_each_entry(hn, &hash[ix], hlist)
82 if (ether_addr_equal_64bits(hn->ai.addr, addr)) {
88 hn->action = MLX5E_ACTION_NONE;
92 hn = kzalloc(sizeof(*hn), GFP_ATOMIC);
96 ether_addr_copy(hn->ai.addr, addr);
97 hn->action = MLX5E_ACTION_ADD;
99 hlist_add_head(&hn->hlist, &hash[ix]);
102 static void mlx5e_del_l2_from_hash(struct mlx5e_l2_hash_node *hn)
104 hlist_del(&hn->hlist);
108 static int mlx5e_vport_context_update_vlans(struct mlx5e_priv *priv)
110 struct net_device *ndev = priv->netdev;
119 for_each_set_bit(vlan, priv->fs.vlan.active_vlans, VLAN_N_VID)
122 max_list_size = 1 << MLX5_CAP_GEN(priv->mdev, log_max_vlan_list);
124 if (list_size > max_list_size) {
126 "netdev vlans list size (%d) > (%d) max vport list size, some vlans will be dropped\n",
127 list_size, max_list_size);
128 list_size = max_list_size;
131 vlans = kcalloc(list_size, sizeof(*vlans), GFP_KERNEL);
136 for_each_set_bit(vlan, priv->fs.vlan.active_vlans, VLAN_N_VID) {
142 err = mlx5_modify_nic_vport_vlans(priv->mdev, vlans, list_size);
144 netdev_err(ndev, "Failed to modify vport vlans list err(%d)\n",
151 enum mlx5e_vlan_rule_type {
152 MLX5E_VLAN_RULE_TYPE_UNTAGGED,
153 MLX5E_VLAN_RULE_TYPE_ANY_VID,
154 MLX5E_VLAN_RULE_TYPE_MATCH_VID,
157 static int __mlx5e_add_vlan_rule(struct mlx5e_priv *priv,
158 enum mlx5e_vlan_rule_type rule_type,
159 u16 vid, u32 *mc, u32 *mv)
161 struct mlx5_flow_table *ft = priv->fs.vlan.ft.t;
162 struct mlx5_flow_destination dest;
163 u8 match_criteria_enable = 0;
164 struct mlx5_flow_rule **rule_p;
167 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
168 dest.ft = priv->fs.l2.ft.t;
170 match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
171 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.vlan_tag);
174 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
175 rule_p = &priv->fs.vlan.untagged_rule;
177 case MLX5E_VLAN_RULE_TYPE_ANY_VID:
178 rule_p = &priv->fs.vlan.any_vlan_rule;
179 MLX5_SET(fte_match_param, mv, outer_headers.vlan_tag, 1);
181 default: /* MLX5E_VLAN_RULE_TYPE_MATCH_VID */
182 rule_p = &priv->fs.vlan.active_vlans_rule[vid];
183 MLX5_SET(fte_match_param, mv, outer_headers.vlan_tag, 1);
184 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
185 MLX5_SET(fte_match_param, mv, outer_headers.first_vid, vid);
189 *rule_p = mlx5_add_flow_rule(ft, match_criteria_enable, mc, mv,
190 MLX5_FLOW_CONTEXT_ACTION_FWD_DEST,
191 MLX5_FS_DEFAULT_FLOW_TAG,
194 if (IS_ERR(*rule_p)) {
195 err = PTR_ERR(*rule_p);
197 netdev_err(priv->netdev, "%s: add rule failed\n", __func__);
203 static int mlx5e_add_vlan_rule(struct mlx5e_priv *priv,
204 enum mlx5e_vlan_rule_type rule_type, u16 vid)
210 match_value = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
211 match_criteria = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
212 if (!match_value || !match_criteria) {
213 netdev_err(priv->netdev, "%s: alloc failed\n", __func__);
215 goto add_vlan_rule_out;
218 if (rule_type == MLX5E_VLAN_RULE_TYPE_MATCH_VID)
219 mlx5e_vport_context_update_vlans(priv);
221 err = __mlx5e_add_vlan_rule(priv, rule_type, vid, match_criteria,
225 kvfree(match_criteria);
231 static void mlx5e_del_vlan_rule(struct mlx5e_priv *priv,
232 enum mlx5e_vlan_rule_type rule_type, u16 vid)
235 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
236 if (priv->fs.vlan.untagged_rule) {
237 mlx5_del_flow_rule(priv->fs.vlan.untagged_rule);
238 priv->fs.vlan.untagged_rule = NULL;
241 case MLX5E_VLAN_RULE_TYPE_ANY_VID:
242 if (priv->fs.vlan.any_vlan_rule) {
243 mlx5_del_flow_rule(priv->fs.vlan.any_vlan_rule);
244 priv->fs.vlan.any_vlan_rule = NULL;
247 case MLX5E_VLAN_RULE_TYPE_MATCH_VID:
248 mlx5e_vport_context_update_vlans(priv);
249 if (priv->fs.vlan.active_vlans_rule[vid]) {
250 mlx5_del_flow_rule(priv->fs.vlan.active_vlans_rule[vid]);
251 priv->fs.vlan.active_vlans_rule[vid] = NULL;
253 mlx5e_vport_context_update_vlans(priv);
258 void mlx5e_enable_vlan_filter(struct mlx5e_priv *priv)
260 if (!priv->fs.vlan.filter_disabled)
263 priv->fs.vlan.filter_disabled = false;
264 if (priv->netdev->flags & IFF_PROMISC)
266 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_VID, 0);
269 void mlx5e_disable_vlan_filter(struct mlx5e_priv *priv)
271 if (priv->fs.vlan.filter_disabled)
274 priv->fs.vlan.filter_disabled = true;
275 if (priv->netdev->flags & IFF_PROMISC)
277 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_VID, 0);
280 int mlx5e_vlan_rx_add_vid(struct net_device *dev, __always_unused __be16 proto,
283 struct mlx5e_priv *priv = netdev_priv(dev);
285 set_bit(vid, priv->fs.vlan.active_vlans);
287 return mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_VID, vid);
290 int mlx5e_vlan_rx_kill_vid(struct net_device *dev, __always_unused __be16 proto,
293 struct mlx5e_priv *priv = netdev_priv(dev);
295 clear_bit(vid, priv->fs.vlan.active_vlans);
297 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_MATCH_VID, vid);
302 #define mlx5e_for_each_hash_node(hn, tmp, hash, i) \
303 for (i = 0; i < MLX5E_L2_ADDR_HASH_SIZE; i++) \
304 hlist_for_each_entry_safe(hn, tmp, &hash[i], hlist)
306 static void mlx5e_execute_l2_action(struct mlx5e_priv *priv,
307 struct mlx5e_l2_hash_node *hn)
309 switch (hn->action) {
310 case MLX5E_ACTION_ADD:
311 mlx5e_add_l2_flow_rule(priv, &hn->ai, MLX5E_FULLMATCH);
312 hn->action = MLX5E_ACTION_NONE;
315 case MLX5E_ACTION_DEL:
316 mlx5e_del_l2_flow_rule(priv, &hn->ai);
317 mlx5e_del_l2_from_hash(hn);
322 static void mlx5e_sync_netdev_addr(struct mlx5e_priv *priv)
324 struct net_device *netdev = priv->netdev;
325 struct netdev_hw_addr *ha;
327 netif_addr_lock_bh(netdev);
329 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_uc,
330 priv->netdev->dev_addr);
332 netdev_for_each_uc_addr(ha, netdev)
333 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_uc, ha->addr);
335 netdev_for_each_mc_addr(ha, netdev)
336 mlx5e_add_l2_to_hash(priv->fs.l2.netdev_mc, ha->addr);
338 netif_addr_unlock_bh(netdev);
341 static void mlx5e_fill_addr_array(struct mlx5e_priv *priv, int list_type,
342 u8 addr_array[][ETH_ALEN], int size)
344 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
345 struct net_device *ndev = priv->netdev;
346 struct mlx5e_l2_hash_node *hn;
347 struct hlist_head *addr_list;
348 struct hlist_node *tmp;
352 addr_list = is_uc ? priv->fs.l2.netdev_uc : priv->fs.l2.netdev_mc;
354 if (is_uc) /* Make sure our own address is pushed first */
355 ether_addr_copy(addr_array[i++], ndev->dev_addr);
356 else if (priv->fs.l2.broadcast_enabled)
357 ether_addr_copy(addr_array[i++], ndev->broadcast);
359 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi) {
360 if (ether_addr_equal(ndev->dev_addr, hn->ai.addr))
364 ether_addr_copy(addr_array[i++], hn->ai.addr);
368 static void mlx5e_vport_context_update_addr_list(struct mlx5e_priv *priv,
371 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
372 struct mlx5e_l2_hash_node *hn;
373 u8 (*addr_array)[ETH_ALEN] = NULL;
374 struct hlist_head *addr_list;
375 struct hlist_node *tmp;
381 size = is_uc ? 0 : (priv->fs.l2.broadcast_enabled ? 1 : 0);
383 1 << MLX5_CAP_GEN(priv->mdev, log_max_current_uc_list) :
384 1 << MLX5_CAP_GEN(priv->mdev, log_max_current_mc_list);
386 addr_list = is_uc ? priv->fs.l2.netdev_uc : priv->fs.l2.netdev_mc;
387 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi)
390 if (size > max_size) {
391 netdev_warn(priv->netdev,
392 "netdev %s list size (%d) > (%d) max vport list size, some addresses will be dropped\n",
393 is_uc ? "UC" : "MC", size, max_size);
398 addr_array = kcalloc(size, ETH_ALEN, GFP_KERNEL);
403 mlx5e_fill_addr_array(priv, list_type, addr_array, size);
406 err = mlx5_modify_nic_vport_mac_list(priv->mdev, list_type, addr_array, size);
409 netdev_err(priv->netdev,
410 "Failed to modify vport %s list err(%d)\n",
411 is_uc ? "UC" : "MC", err);
415 static void mlx5e_vport_context_update(struct mlx5e_priv *priv)
417 struct mlx5e_l2_table *ea = &priv->fs.l2;
419 mlx5e_vport_context_update_addr_list(priv, MLX5_NVPRT_LIST_TYPE_UC);
420 mlx5e_vport_context_update_addr_list(priv, MLX5_NVPRT_LIST_TYPE_MC);
421 mlx5_modify_nic_vport_promisc(priv->mdev, 0,
422 ea->allmulti_enabled,
423 ea->promisc_enabled);
426 static void mlx5e_apply_netdev_addr(struct mlx5e_priv *priv)
428 struct mlx5e_l2_hash_node *hn;
429 struct hlist_node *tmp;
432 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_uc, i)
433 mlx5e_execute_l2_action(priv, hn);
435 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_mc, i)
436 mlx5e_execute_l2_action(priv, hn);
439 static void mlx5e_handle_netdev_addr(struct mlx5e_priv *priv)
441 struct mlx5e_l2_hash_node *hn;
442 struct hlist_node *tmp;
445 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_uc, i)
446 hn->action = MLX5E_ACTION_DEL;
447 mlx5e_for_each_hash_node(hn, tmp, priv->fs.l2.netdev_mc, i)
448 hn->action = MLX5E_ACTION_DEL;
450 if (!test_bit(MLX5E_STATE_DESTROYING, &priv->state))
451 mlx5e_sync_netdev_addr(priv);
453 mlx5e_apply_netdev_addr(priv);
456 void mlx5e_set_rx_mode_work(struct work_struct *work)
458 struct mlx5e_priv *priv = container_of(work, struct mlx5e_priv,
461 struct mlx5e_l2_table *ea = &priv->fs.l2;
462 struct net_device *ndev = priv->netdev;
464 bool rx_mode_enable = !test_bit(MLX5E_STATE_DESTROYING, &priv->state);
465 bool promisc_enabled = rx_mode_enable && (ndev->flags & IFF_PROMISC);
466 bool allmulti_enabled = rx_mode_enable && (ndev->flags & IFF_ALLMULTI);
467 bool broadcast_enabled = rx_mode_enable;
469 bool enable_promisc = !ea->promisc_enabled && promisc_enabled;
470 bool disable_promisc = ea->promisc_enabled && !promisc_enabled;
471 bool enable_allmulti = !ea->allmulti_enabled && allmulti_enabled;
472 bool disable_allmulti = ea->allmulti_enabled && !allmulti_enabled;
473 bool enable_broadcast = !ea->broadcast_enabled && broadcast_enabled;
474 bool disable_broadcast = ea->broadcast_enabled && !broadcast_enabled;
476 if (enable_promisc) {
477 mlx5e_add_l2_flow_rule(priv, &ea->promisc, MLX5E_PROMISC);
478 if (!priv->fs.vlan.filter_disabled)
479 mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_VID,
483 mlx5e_add_l2_flow_rule(priv, &ea->allmulti, MLX5E_ALLMULTI);
484 if (enable_broadcast)
485 mlx5e_add_l2_flow_rule(priv, &ea->broadcast, MLX5E_FULLMATCH);
487 mlx5e_handle_netdev_addr(priv);
489 if (disable_broadcast)
490 mlx5e_del_l2_flow_rule(priv, &ea->broadcast);
491 if (disable_allmulti)
492 mlx5e_del_l2_flow_rule(priv, &ea->allmulti);
493 if (disable_promisc) {
494 if (!priv->fs.vlan.filter_disabled)
495 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_ANY_VID,
497 mlx5e_del_l2_flow_rule(priv, &ea->promisc);
500 ea->promisc_enabled = promisc_enabled;
501 ea->allmulti_enabled = allmulti_enabled;
502 ea->broadcast_enabled = broadcast_enabled;
504 mlx5e_vport_context_update(priv);
507 static void mlx5e_destroy_groups(struct mlx5e_flow_table *ft)
511 for (i = ft->num_groups - 1; i >= 0; i--) {
512 if (!IS_ERR_OR_NULL(ft->g[i]))
513 mlx5_destroy_flow_group(ft->g[i]);
519 void mlx5e_init_l2_addr(struct mlx5e_priv *priv)
521 ether_addr_copy(priv->fs.l2.broadcast.addr, priv->netdev->broadcast);
524 void mlx5e_destroy_flow_table(struct mlx5e_flow_table *ft)
526 mlx5e_destroy_groups(ft);
528 mlx5_destroy_flow_table(ft->t);
532 static void mlx5e_cleanup_ttc_rules(struct mlx5e_ttc_table *ttc)
536 for (i = 0; i < MLX5E_NUM_TT; i++) {
537 if (!IS_ERR_OR_NULL(ttc->rules[i])) {
538 mlx5_del_flow_rule(ttc->rules[i]);
539 ttc->rules[i] = NULL;
548 [MLX5E_TT_IPV4_TCP] = {
550 .proto = IPPROTO_TCP,
552 [MLX5E_TT_IPV6_TCP] = {
554 .proto = IPPROTO_TCP,
556 [MLX5E_TT_IPV4_UDP] = {
558 .proto = IPPROTO_UDP,
560 [MLX5E_TT_IPV6_UDP] = {
562 .proto = IPPROTO_UDP,
564 [MLX5E_TT_IPV4_IPSEC_AH] = {
568 [MLX5E_TT_IPV6_IPSEC_AH] = {
572 [MLX5E_TT_IPV4_IPSEC_ESP] = {
574 .proto = IPPROTO_ESP,
576 [MLX5E_TT_IPV6_IPSEC_ESP] = {
578 .proto = IPPROTO_ESP,
594 static struct mlx5_flow_rule *mlx5e_generate_ttc_rule(struct mlx5e_priv *priv,
595 struct mlx5_flow_table *ft,
596 struct mlx5_flow_destination *dest,
600 struct mlx5_flow_rule *rule;
601 u8 match_criteria_enable = 0;
606 match_value = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
607 match_criteria = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
608 if (!match_value || !match_criteria) {
609 netdev_err(priv->netdev, "%s: alloc failed\n", __func__);
615 match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
616 MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.ip_protocol);
617 MLX5_SET(fte_match_param, match_value, outer_headers.ip_protocol, proto);
620 match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
621 MLX5_SET_TO_ONES(fte_match_param, match_criteria, outer_headers.ethertype);
622 MLX5_SET(fte_match_param, match_value, outer_headers.ethertype, etype);
625 rule = mlx5_add_flow_rule(ft, match_criteria_enable,
626 match_criteria, match_value,
627 MLX5_FLOW_CONTEXT_ACTION_FWD_DEST,
628 MLX5_FS_DEFAULT_FLOW_TAG,
632 netdev_err(priv->netdev, "%s: add rule failed\n", __func__);
635 kvfree(match_criteria);
637 return err ? ERR_PTR(err) : rule;
640 static int mlx5e_generate_ttc_table_rules(struct mlx5e_priv *priv)
642 struct mlx5_flow_destination dest;
643 struct mlx5e_ttc_table *ttc;
644 struct mlx5_flow_rule **rules;
645 struct mlx5_flow_table *ft;
653 dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
654 for (tt = 0; tt < MLX5E_NUM_TT; tt++) {
655 if (tt == MLX5E_TT_ANY)
656 dest.tir_num = priv->direct_tir[0].tirn;
658 dest.tir_num = priv->indir_tirn[tt];
659 rules[tt] = mlx5e_generate_ttc_rule(priv, ft, &dest,
661 ttc_rules[tt].proto);
662 if (IS_ERR(rules[tt]))
669 err = PTR_ERR(rules[tt]);
671 mlx5e_cleanup_ttc_rules(ttc);
675 #define MLX5E_TTC_NUM_GROUPS 3
676 #define MLX5E_TTC_GROUP1_SIZE BIT(3)
677 #define MLX5E_TTC_GROUP2_SIZE BIT(1)
678 #define MLX5E_TTC_GROUP3_SIZE BIT(0)
679 #define MLX5E_TTC_TABLE_SIZE (MLX5E_TTC_GROUP1_SIZE +\
680 MLX5E_TTC_GROUP2_SIZE +\
681 MLX5E_TTC_GROUP3_SIZE)
682 static int mlx5e_create_ttc_table_groups(struct mlx5e_ttc_table *ttc)
684 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
685 struct mlx5e_flow_table *ft = &ttc->ft;
691 ft->g = kcalloc(MLX5E_TTC_NUM_GROUPS,
692 sizeof(*ft->g), GFP_KERNEL);
695 in = mlx5_vzalloc(inlen);
702 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
703 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.ip_protocol);
704 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.ethertype);
705 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
706 MLX5_SET_CFG(in, start_flow_index, ix);
707 ix += MLX5E_TTC_GROUP1_SIZE;
708 MLX5_SET_CFG(in, end_flow_index, ix - 1);
709 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
710 if (IS_ERR(ft->g[ft->num_groups]))
715 MLX5_SET(fte_match_param, mc, outer_headers.ip_protocol, 0);
716 MLX5_SET_CFG(in, start_flow_index, ix);
717 ix += MLX5E_TTC_GROUP2_SIZE;
718 MLX5_SET_CFG(in, end_flow_index, ix - 1);
719 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
720 if (IS_ERR(ft->g[ft->num_groups]))
725 memset(in, 0, inlen);
726 MLX5_SET_CFG(in, start_flow_index, ix);
727 ix += MLX5E_TTC_GROUP3_SIZE;
728 MLX5_SET_CFG(in, end_flow_index, ix - 1);
729 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
730 if (IS_ERR(ft->g[ft->num_groups]))
738 err = PTR_ERR(ft->g[ft->num_groups]);
739 ft->g[ft->num_groups] = NULL;
745 static void mlx5e_destroy_ttc_table(struct mlx5e_priv *priv)
747 struct mlx5e_ttc_table *ttc = &priv->fs.ttc;
749 mlx5e_cleanup_ttc_rules(ttc);
750 mlx5e_destroy_flow_table(&ttc->ft);
753 static int mlx5e_create_ttc_table(struct mlx5e_priv *priv)
755 struct mlx5e_ttc_table *ttc = &priv->fs.ttc;
756 struct mlx5e_flow_table *ft = &ttc->ft;
759 ft->t = mlx5_create_flow_table(priv->fs.ns, MLX5E_NIC_PRIO,
760 MLX5E_TTC_TABLE_SIZE, MLX5E_TTC_FT_LEVEL);
762 err = PTR_ERR(ft->t);
767 err = mlx5e_create_ttc_table_groups(ttc);
771 err = mlx5e_generate_ttc_table_rules(priv);
777 mlx5e_destroy_flow_table(ft);
781 static void mlx5e_del_l2_flow_rule(struct mlx5e_priv *priv,
782 struct mlx5e_l2_rule *ai)
784 if (!IS_ERR_OR_NULL(ai->rule)) {
785 mlx5_del_flow_rule(ai->rule);
790 static int mlx5e_add_l2_flow_rule(struct mlx5e_priv *priv,
791 struct mlx5e_l2_rule *ai, int type)
793 struct mlx5_flow_table *ft = priv->fs.l2.ft.t;
794 struct mlx5_flow_destination dest;
795 u8 match_criteria_enable = 0;
802 match_value = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
803 match_criteria = mlx5_vzalloc(MLX5_ST_SZ_BYTES(fte_match_param));
804 if (!match_value || !match_criteria) {
805 netdev_err(priv->netdev, "%s: alloc failed\n", __func__);
807 goto add_l2_rule_out;
810 mc_dmac = MLX5_ADDR_OF(fte_match_param, match_criteria,
811 outer_headers.dmac_47_16);
812 mv_dmac = MLX5_ADDR_OF(fte_match_param, match_value,
813 outer_headers.dmac_47_16);
815 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
816 dest.ft = priv->fs.ttc.ft.t;
819 case MLX5E_FULLMATCH:
820 match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
821 eth_broadcast_addr(mc_dmac);
822 ether_addr_copy(mv_dmac, ai->addr);
826 match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
835 ai->rule = mlx5_add_flow_rule(ft, match_criteria_enable, match_criteria,
837 MLX5_FLOW_CONTEXT_ACTION_FWD_DEST,
838 MLX5_FS_DEFAULT_FLOW_TAG, &dest);
839 if (IS_ERR(ai->rule)) {
840 netdev_err(priv->netdev, "%s: add l2 rule(mac:%pM) failed\n",
842 err = PTR_ERR(ai->rule);
847 kvfree(match_criteria);
853 #define MLX5E_NUM_L2_GROUPS 3
854 #define MLX5E_L2_GROUP1_SIZE BIT(0)
855 #define MLX5E_L2_GROUP2_SIZE BIT(15)
856 #define MLX5E_L2_GROUP3_SIZE BIT(0)
857 #define MLX5E_L2_TABLE_SIZE (MLX5E_L2_GROUP1_SIZE +\
858 MLX5E_L2_GROUP2_SIZE +\
859 MLX5E_L2_GROUP3_SIZE)
860 static int mlx5e_create_l2_table_groups(struct mlx5e_l2_table *l2_table)
862 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
863 struct mlx5e_flow_table *ft = &l2_table->ft;
870 ft->g = kcalloc(MLX5E_NUM_L2_GROUPS, sizeof(*ft->g), GFP_KERNEL);
873 in = mlx5_vzalloc(inlen);
879 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
880 mc_dmac = MLX5_ADDR_OF(fte_match_param, mc,
881 outer_headers.dmac_47_16);
882 /* Flow Group for promiscuous */
883 MLX5_SET_CFG(in, start_flow_index, ix);
884 ix += MLX5E_L2_GROUP1_SIZE;
885 MLX5_SET_CFG(in, end_flow_index, ix - 1);
886 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
887 if (IS_ERR(ft->g[ft->num_groups]))
888 goto err_destroy_groups;
891 /* Flow Group for full match */
892 eth_broadcast_addr(mc_dmac);
893 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
894 MLX5_SET_CFG(in, start_flow_index, ix);
895 ix += MLX5E_L2_GROUP2_SIZE;
896 MLX5_SET_CFG(in, end_flow_index, ix - 1);
897 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
898 if (IS_ERR(ft->g[ft->num_groups]))
899 goto err_destroy_groups;
902 /* Flow Group for allmulti */
903 eth_zero_addr(mc_dmac);
905 MLX5_SET_CFG(in, start_flow_index, ix);
906 ix += MLX5E_L2_GROUP3_SIZE;
907 MLX5_SET_CFG(in, end_flow_index, ix - 1);
908 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
909 if (IS_ERR(ft->g[ft->num_groups]))
910 goto err_destroy_groups;
917 err = PTR_ERR(ft->g[ft->num_groups]);
918 ft->g[ft->num_groups] = NULL;
919 mlx5e_destroy_groups(ft);
925 static void mlx5e_destroy_l2_table(struct mlx5e_priv *priv)
927 mlx5e_destroy_flow_table(&priv->fs.l2.ft);
930 static int mlx5e_create_l2_table(struct mlx5e_priv *priv)
932 struct mlx5e_l2_table *l2_table = &priv->fs.l2;
933 struct mlx5e_flow_table *ft = &l2_table->ft;
937 ft->t = mlx5_create_flow_table(priv->fs.ns, MLX5E_NIC_PRIO,
938 MLX5E_L2_TABLE_SIZE, MLX5E_L2_FT_LEVEL);
941 err = PTR_ERR(ft->t);
946 err = mlx5e_create_l2_table_groups(l2_table);
948 goto err_destroy_flow_table;
952 err_destroy_flow_table:
953 mlx5_destroy_flow_table(ft->t);
959 #define MLX5E_NUM_VLAN_GROUPS 2
960 #define MLX5E_VLAN_GROUP0_SIZE BIT(12)
961 #define MLX5E_VLAN_GROUP1_SIZE BIT(1)
962 #define MLX5E_VLAN_TABLE_SIZE (MLX5E_VLAN_GROUP0_SIZE +\
963 MLX5E_VLAN_GROUP1_SIZE)
965 static int __mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft, u32 *in,
970 u8 *mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
972 memset(in, 0, inlen);
973 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
974 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.vlan_tag);
975 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
976 MLX5_SET_CFG(in, start_flow_index, ix);
977 ix += MLX5E_VLAN_GROUP0_SIZE;
978 MLX5_SET_CFG(in, end_flow_index, ix - 1);
979 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
980 if (IS_ERR(ft->g[ft->num_groups]))
981 goto err_destroy_groups;
984 memset(in, 0, inlen);
985 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
986 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.vlan_tag);
987 MLX5_SET_CFG(in, start_flow_index, ix);
988 ix += MLX5E_VLAN_GROUP1_SIZE;
989 MLX5_SET_CFG(in, end_flow_index, ix - 1);
990 ft->g[ft->num_groups] = mlx5_create_flow_group(ft->t, in);
991 if (IS_ERR(ft->g[ft->num_groups]))
992 goto err_destroy_groups;
998 err = PTR_ERR(ft->g[ft->num_groups]);
999 ft->g[ft->num_groups] = NULL;
1000 mlx5e_destroy_groups(ft);
1005 static int mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft)
1008 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1011 in = mlx5_vzalloc(inlen);
1015 err = __mlx5e_create_vlan_table_groups(ft, in, inlen);
1021 static int mlx5e_create_vlan_table(struct mlx5e_priv *priv)
1023 struct mlx5e_flow_table *ft = &priv->fs.vlan.ft;
1027 ft->t = mlx5_create_flow_table(priv->fs.ns, MLX5E_NIC_PRIO,
1028 MLX5E_VLAN_TABLE_SIZE, MLX5E_VLAN_FT_LEVEL);
1030 if (IS_ERR(ft->t)) {
1031 err = PTR_ERR(ft->t);
1035 ft->g = kcalloc(MLX5E_NUM_VLAN_GROUPS, sizeof(*ft->g), GFP_KERNEL);
1038 goto err_destroy_vlan_table;
1041 err = mlx5e_create_vlan_table_groups(ft);
1045 err = mlx5e_add_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_UNTAGGED, 0);
1047 goto err_destroy_vlan_flow_groups;
1051 err_destroy_vlan_flow_groups:
1052 mlx5e_destroy_groups(ft);
1055 err_destroy_vlan_table:
1056 mlx5_destroy_flow_table(ft->t);
1062 static void mlx5e_destroy_vlan_table(struct mlx5e_priv *priv)
1064 mlx5e_destroy_flow_table(&priv->fs.vlan.ft);
1067 int mlx5e_create_flow_steering(struct mlx5e_priv *priv)
1071 priv->fs.ns = mlx5_get_flow_namespace(priv->mdev,
1072 MLX5_FLOW_NAMESPACE_KERNEL);
1077 err = mlx5e_arfs_create_tables(priv);
1079 netdev_err(priv->netdev, "Failed to create arfs tables, err=%d\n",
1081 priv->netdev->hw_features &= ~NETIF_F_NTUPLE;
1084 err = mlx5e_create_ttc_table(priv);
1086 netdev_err(priv->netdev, "Failed to create ttc table, err=%d\n",
1088 goto err_destroy_arfs_tables;
1091 err = mlx5e_create_l2_table(priv);
1093 netdev_err(priv->netdev, "Failed to create l2 table, err=%d\n",
1095 goto err_destroy_ttc_table;
1098 err = mlx5e_create_vlan_table(priv);
1100 netdev_err(priv->netdev, "Failed to create vlan table, err=%d\n",
1102 goto err_destroy_l2_table;
1107 err_destroy_l2_table:
1108 mlx5e_destroy_l2_table(priv);
1109 err_destroy_ttc_table:
1110 mlx5e_destroy_ttc_table(priv);
1111 err_destroy_arfs_tables:
1112 mlx5e_arfs_destroy_tables(priv);
1117 void mlx5e_destroy_flow_steering(struct mlx5e_priv *priv)
1119 mlx5e_del_vlan_rule(priv, MLX5E_VLAN_RULE_TYPE_UNTAGGED, 0);
1120 mlx5e_destroy_vlan_table(priv);
1121 mlx5e_destroy_l2_table(priv);
1122 mlx5e_destroy_ttc_table(priv);
1123 mlx5e_arfs_destroy_tables(priv);