1e8f887acSAmir Vadai /* 2e8f887acSAmir Vadai * Copyright (c) 2016, Mellanox Technologies. All rights reserved. 3e8f887acSAmir Vadai * 4e8f887acSAmir Vadai * This software is available to you under a choice of one of two 5e8f887acSAmir Vadai * licenses. You may choose to be licensed under the terms of the GNU 6e8f887acSAmir Vadai * General Public License (GPL) Version 2, available from the file 7e8f887acSAmir Vadai * COPYING in the main directory of this source tree, or the 8e8f887acSAmir Vadai * OpenIB.org BSD license below: 9e8f887acSAmir Vadai * 10e8f887acSAmir Vadai * Redistribution and use in source and binary forms, with or 11e8f887acSAmir Vadai * without modification, are permitted provided that the following 12e8f887acSAmir Vadai * conditions are met: 13e8f887acSAmir Vadai * 14e8f887acSAmir Vadai * - Redistributions of source code must retain the above 15e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 16e8f887acSAmir Vadai * disclaimer. 17e8f887acSAmir Vadai * 18e8f887acSAmir Vadai * - Redistributions in binary form must reproduce the above 19e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 20e8f887acSAmir Vadai * disclaimer in the documentation and/or other materials 21e8f887acSAmir Vadai * provided with the distribution. 22e8f887acSAmir Vadai * 23e8f887acSAmir Vadai * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24e8f887acSAmir Vadai * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25e8f887acSAmir Vadai * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26e8f887acSAmir Vadai * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27e8f887acSAmir Vadai * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28e8f887acSAmir Vadai * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29e8f887acSAmir Vadai * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30e8f887acSAmir Vadai * SOFTWARE. 31e8f887acSAmir Vadai */ 32e8f887acSAmir Vadai 33e3a2b7edSAmir Vadai #include <net/flow_dissector.h> 343f7d0eb4SOr Gerlitz #include <net/sch_generic.h> 35e3a2b7edSAmir Vadai #include <net/pkt_cls.h> 36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h> 3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h> 38e8f887acSAmir Vadai #include <linux/mlx5/fs.h> 39e8f887acSAmir Vadai #include <linux/mlx5/device.h> 40e8f887acSAmir Vadai #include <linux/rhashtable.h> 4103a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h> 42776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h> 43bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h> 44d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h> 4526c02749SOr Gerlitz #include <net/tc_act/tc_csum.h> 46f6dfb4c3SHadar Hen Zion #include <net/arp.h> 473616d08bSDavid Ahern #include <net/ipv6_stubs.h> 48e8f887acSAmir Vadai #include "en.h" 491d447a39SSaeed Mahameed #include "en_rep.h" 50232c0013SHadar Hen Zion #include "en_tc.h" 5103a9d11eSOr Gerlitz #include "eswitch.h" 523f6d08d1SOr Gerlitz #include "fs_core.h" 532c81bfd5SHuy Nguyen #include "en/port.h" 54101f4de9SOz Shlomo #include "en/tc_tun.h" 5504de7ddaSRoi Dayan #include "lib/devcom.h" 56e8f887acSAmir Vadai 573bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr { 583bc4b7bfSOr Gerlitz u32 action; 593bc4b7bfSOr Gerlitz u32 flow_tag; 602f4fe4caSOr Gerlitz u32 mod_hdr_id; 615c65c564SOr Gerlitz u32 hairpin_tirn; 6238aa51c1SOr Gerlitz u8 match_level; 633f6d08d1SOr Gerlitz struct mlx5_flow_table *hairpin_ft; 64b8aee822SMark Bloch struct mlx5_fc *counter; 653bc4b7bfSOr Gerlitz }; 663bc4b7bfSOr Gerlitz 6760bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1) 6860bd4af8SOr Gerlitz 6965ba8fb7SOr Gerlitz enum { 7060bd4af8SOr Gerlitz MLX5E_TC_FLOW_INGRESS = MLX5E_TC_INGRESS, 7160bd4af8SOr Gerlitz MLX5E_TC_FLOW_EGRESS = MLX5E_TC_EGRESS, 72d9ee0491SOr Gerlitz MLX5E_TC_FLOW_ESWITCH = MLX5E_TC_ESW_OFFLOAD, 73d9ee0491SOr Gerlitz MLX5E_TC_FLOW_NIC = MLX5E_TC_NIC_OFFLOAD, 74d9ee0491SOr Gerlitz MLX5E_TC_FLOW_OFFLOADED = BIT(MLX5E_TC_FLOW_BASE), 75d9ee0491SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN = BIT(MLX5E_TC_FLOW_BASE + 1), 76d9ee0491SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 2), 77d9ee0491SOr Gerlitz MLX5E_TC_FLOW_SLOW = BIT(MLX5E_TC_FLOW_BASE + 3), 78d9ee0491SOr Gerlitz MLX5E_TC_FLOW_DUP = BIT(MLX5E_TC_FLOW_BASE + 4), 79ef06c9eeSRoi Dayan MLX5E_TC_FLOW_NOT_READY = BIT(MLX5E_TC_FLOW_BASE + 5), 8065ba8fb7SOr Gerlitz }; 8165ba8fb7SOr Gerlitz 82e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1 83e4ad91f2SChris Mi 8479baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array. 8579baaec7SEli Britstein * Containing struct 8679baaec7SEli Britstein * |- Helper array 8779baaec7SEli Britstein * [0] Helper item 0 8879baaec7SEli Britstein * |- list_head item 0 8979baaec7SEli Britstein * |- index (0) 9079baaec7SEli Britstein * [1] Helper item 1 9179baaec7SEli Britstein * |- list_head item 1 9279baaec7SEli Britstein * |- index (1) 9379baaec7SEli Britstein * To access the containing struct from one of the list_head items: 9479baaec7SEli Britstein * 1. Get the helper item from the list_head item using 9579baaec7SEli Britstein * helper item = 9679baaec7SEli Britstein * container_of(list_head item, helper struct type, list_head field) 9779baaec7SEli Britstein * 2. Get the contining struct from the helper item and its index in the array: 9879baaec7SEli Britstein * containing struct = 9979baaec7SEli Britstein * container_of(helper item, containing struct type, helper field[index]) 10079baaec7SEli Britstein */ 10179baaec7SEli Britstein struct encap_flow_item { 10279baaec7SEli Britstein struct list_head list; 10379baaec7SEli Britstein int index; 10479baaec7SEli Britstein }; 10579baaec7SEli Britstein 106e8f887acSAmir Vadai struct mlx5e_tc_flow { 107e8f887acSAmir Vadai struct rhash_head node; 108655dc3d2SOr Gerlitz struct mlx5e_priv *priv; 109e8f887acSAmir Vadai u64 cookie; 1105dbe906fSPaul Blakey u16 flags; 111e4ad91f2SChris Mi struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1]; 11279baaec7SEli Britstein /* Flow can be associated with multiple encap IDs. 11379baaec7SEli Britstein * The number of encaps is bounded by the number of supported 11479baaec7SEli Britstein * destinations. 11579baaec7SEli Britstein */ 11679baaec7SEli Britstein struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS]; 11704de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 11811c9c548SOr Gerlitz struct list_head mod_hdr; /* flows sharing the same mod hdr ID */ 1195c65c564SOr Gerlitz struct list_head hairpin; /* flows sharing the same hairpin */ 12004de7ddaSRoi Dayan struct list_head peer; /* flows with peer flow */ 121b4a23329SRoi Dayan struct list_head unready; /* flows not ready to be offloaded (e.g due to missing route) */ 1223bc4b7bfSOr Gerlitz union { 123ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 1243bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 1253bc4b7bfSOr Gerlitz }; 126e8f887acSAmir Vadai }; 127e8f887acSAmir Vadai 12817091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 1291f6da306SYevgeny Kliteynik const struct ip_tunnel_info *tun_info[MLX5_MAX_FLOW_FWD_VPORTS]; 130d11afc26SOz Shlomo struct net_device *filter_dev; 13117091853SOr Gerlitz struct mlx5_flow_spec spec; 132d79b6df6SOr Gerlitz int num_mod_hdr_actions; 133218d05ceSTonghao Zhang int max_mod_hdr_actions; 134d79b6df6SOr Gerlitz void *mod_hdr_actions; 13598b66cb1SEli Britstein int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS]; 13617091853SOr Gerlitz }; 13717091853SOr Gerlitz 138acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 139b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16) 140e8f887acSAmir Vadai 14177ab67b7SOr Gerlitz struct mlx5e_hairpin { 14277ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 14377ab67b7SOr Gerlitz 14477ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev; 1453f6d08d1SOr Gerlitz struct mlx5e_priv *func_priv; 14677ab67b7SOr Gerlitz u32 tdn; 14777ab67b7SOr Gerlitz u32 tirn; 1483f6d08d1SOr Gerlitz 1493f6d08d1SOr Gerlitz int num_channels; 1503f6d08d1SOr Gerlitz struct mlx5e_rqt indir_rqt; 1513f6d08d1SOr Gerlitz u32 indir_tirn[MLX5E_NUM_INDIR_TIRS]; 1523f6d08d1SOr Gerlitz struct mlx5e_ttc_table ttc; 15377ab67b7SOr Gerlitz }; 15477ab67b7SOr Gerlitz 1555c65c564SOr Gerlitz struct mlx5e_hairpin_entry { 1565c65c564SOr Gerlitz /* a node of a hash table which keeps all the hairpin entries */ 1575c65c564SOr Gerlitz struct hlist_node hairpin_hlist; 1585c65c564SOr Gerlitz 1595c65c564SOr Gerlitz /* flows sharing the same hairpin */ 1605c65c564SOr Gerlitz struct list_head flows; 1615c65c564SOr Gerlitz 162d8822868SOr Gerlitz u16 peer_vhca_id; 163106be53bSOr Gerlitz u8 prio; 1645c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 1655c65c564SOr Gerlitz }; 1665c65c564SOr Gerlitz 16711c9c548SOr Gerlitz struct mod_hdr_key { 16811c9c548SOr Gerlitz int num_actions; 16911c9c548SOr Gerlitz void *actions; 17011c9c548SOr Gerlitz }; 17111c9c548SOr Gerlitz 17211c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry { 17311c9c548SOr Gerlitz /* a node of a hash table which keeps all the mod_hdr entries */ 17411c9c548SOr Gerlitz struct hlist_node mod_hdr_hlist; 17511c9c548SOr Gerlitz 17611c9c548SOr Gerlitz /* flows sharing the same mod_hdr entry */ 17711c9c548SOr Gerlitz struct list_head flows; 17811c9c548SOr Gerlitz 17911c9c548SOr Gerlitz struct mod_hdr_key key; 18011c9c548SOr Gerlitz 18111c9c548SOr Gerlitz u32 mod_hdr_id; 18211c9c548SOr Gerlitz }; 18311c9c548SOr Gerlitz 18411c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto) 18511c9c548SOr Gerlitz 18611c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key) 18711c9c548SOr Gerlitz { 18811c9c548SOr Gerlitz return jhash(key->actions, 18911c9c548SOr Gerlitz key->num_actions * MLX5_MH_ACT_SZ, 0); 19011c9c548SOr Gerlitz } 19111c9c548SOr Gerlitz 19211c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a, 19311c9c548SOr Gerlitz struct mod_hdr_key *b) 19411c9c548SOr Gerlitz { 19511c9c548SOr Gerlitz if (a->num_actions != b->num_actions) 19611c9c548SOr Gerlitz return 1; 19711c9c548SOr Gerlitz 19811c9c548SOr Gerlitz return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ); 19911c9c548SOr Gerlitz } 20011c9c548SOr Gerlitz 20111c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv, 20211c9c548SOr Gerlitz struct mlx5e_tc_flow *flow, 20311c9c548SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 20411c9c548SOr Gerlitz { 20511c9c548SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 20611c9c548SOr Gerlitz int num_actions, actions_size, namespace, err; 20711c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 20811c9c548SOr Gerlitz struct mod_hdr_key key; 20911c9c548SOr Gerlitz bool found = false; 21011c9c548SOr Gerlitz u32 hash_key; 21111c9c548SOr Gerlitz 21211c9c548SOr Gerlitz num_actions = parse_attr->num_mod_hdr_actions; 21311c9c548SOr Gerlitz actions_size = MLX5_MH_ACT_SZ * num_actions; 21411c9c548SOr Gerlitz 21511c9c548SOr Gerlitz key.actions = parse_attr->mod_hdr_actions; 21611c9c548SOr Gerlitz key.num_actions = num_actions; 21711c9c548SOr Gerlitz 21811c9c548SOr Gerlitz hash_key = hash_mod_hdr_info(&key); 21911c9c548SOr Gerlitz 22011c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 22111c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_FDB; 22211c9c548SOr Gerlitz hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh, 22311c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 22411c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 22511c9c548SOr Gerlitz found = true; 22611c9c548SOr Gerlitz break; 22711c9c548SOr Gerlitz } 22811c9c548SOr Gerlitz } 22911c9c548SOr Gerlitz } else { 23011c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_KERNEL; 23111c9c548SOr Gerlitz hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh, 23211c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 23311c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 23411c9c548SOr Gerlitz found = true; 23511c9c548SOr Gerlitz break; 23611c9c548SOr Gerlitz } 23711c9c548SOr Gerlitz } 23811c9c548SOr Gerlitz } 23911c9c548SOr Gerlitz 24011c9c548SOr Gerlitz if (found) 24111c9c548SOr Gerlitz goto attach_flow; 24211c9c548SOr Gerlitz 24311c9c548SOr Gerlitz mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL); 24411c9c548SOr Gerlitz if (!mh) 24511c9c548SOr Gerlitz return -ENOMEM; 24611c9c548SOr Gerlitz 24711c9c548SOr Gerlitz mh->key.actions = (void *)mh + sizeof(*mh); 24811c9c548SOr Gerlitz memcpy(mh->key.actions, key.actions, actions_size); 24911c9c548SOr Gerlitz mh->key.num_actions = num_actions; 25011c9c548SOr Gerlitz INIT_LIST_HEAD(&mh->flows); 25111c9c548SOr Gerlitz 25211c9c548SOr Gerlitz err = mlx5_modify_header_alloc(priv->mdev, namespace, 25311c9c548SOr Gerlitz mh->key.num_actions, 25411c9c548SOr Gerlitz mh->key.actions, 25511c9c548SOr Gerlitz &mh->mod_hdr_id); 25611c9c548SOr Gerlitz if (err) 25711c9c548SOr Gerlitz goto out_err; 25811c9c548SOr Gerlitz 25911c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 26011c9c548SOr Gerlitz hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 26111c9c548SOr Gerlitz else 26211c9c548SOr Gerlitz hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 26311c9c548SOr Gerlitz 26411c9c548SOr Gerlitz attach_flow: 26511c9c548SOr Gerlitz list_add(&flow->mod_hdr, &mh->flows); 26611c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 26711c9c548SOr Gerlitz flow->esw_attr->mod_hdr_id = mh->mod_hdr_id; 26811c9c548SOr Gerlitz else 26911c9c548SOr Gerlitz flow->nic_attr->mod_hdr_id = mh->mod_hdr_id; 27011c9c548SOr Gerlitz 27111c9c548SOr Gerlitz return 0; 27211c9c548SOr Gerlitz 27311c9c548SOr Gerlitz out_err: 27411c9c548SOr Gerlitz kfree(mh); 27511c9c548SOr Gerlitz return err; 27611c9c548SOr Gerlitz } 27711c9c548SOr Gerlitz 27811c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv, 27911c9c548SOr Gerlitz struct mlx5e_tc_flow *flow) 28011c9c548SOr Gerlitz { 28111c9c548SOr Gerlitz struct list_head *next = flow->mod_hdr.next; 28211c9c548SOr Gerlitz 28311c9c548SOr Gerlitz list_del(&flow->mod_hdr); 28411c9c548SOr Gerlitz 28511c9c548SOr Gerlitz if (list_empty(next)) { 28611c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 28711c9c548SOr Gerlitz 28811c9c548SOr Gerlitz mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows); 28911c9c548SOr Gerlitz 29011c9c548SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id); 29111c9c548SOr Gerlitz hash_del(&mh->mod_hdr_hlist); 29211c9c548SOr Gerlitz kfree(mh); 29311c9c548SOr Gerlitz } 29411c9c548SOr Gerlitz } 29511c9c548SOr Gerlitz 29677ab67b7SOr Gerlitz static 29777ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex) 29877ab67b7SOr Gerlitz { 29977ab67b7SOr Gerlitz struct net_device *netdev; 30077ab67b7SOr Gerlitz struct mlx5e_priv *priv; 30177ab67b7SOr Gerlitz 30277ab67b7SOr Gerlitz netdev = __dev_get_by_index(net, ifindex); 30377ab67b7SOr Gerlitz priv = netdev_priv(netdev); 30477ab67b7SOr Gerlitz return priv->mdev; 30577ab67b7SOr Gerlitz } 30677ab67b7SOr Gerlitz 30777ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp) 30877ab67b7SOr Gerlitz { 30977ab67b7SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0}; 31077ab67b7SOr Gerlitz void *tirc; 31177ab67b7SOr Gerlitz int err; 31277ab67b7SOr Gerlitz 31377ab67b7SOr Gerlitz err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn); 31477ab67b7SOr Gerlitz if (err) 31577ab67b7SOr Gerlitz goto alloc_tdn_err; 31677ab67b7SOr Gerlitz 31777ab67b7SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 31877ab67b7SOr Gerlitz 31977ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT); 320ddae74acSOr Gerlitz MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]); 32177ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 32277ab67b7SOr Gerlitz 32377ab67b7SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn); 32477ab67b7SOr Gerlitz if (err) 32577ab67b7SOr Gerlitz goto create_tir_err; 32677ab67b7SOr Gerlitz 32777ab67b7SOr Gerlitz return 0; 32877ab67b7SOr Gerlitz 32977ab67b7SOr Gerlitz create_tir_err: 33077ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 33177ab67b7SOr Gerlitz alloc_tdn_err: 33277ab67b7SOr Gerlitz return err; 33377ab67b7SOr Gerlitz } 33477ab67b7SOr Gerlitz 33577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp) 33677ab67b7SOr Gerlitz { 33777ab67b7SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->tirn); 33877ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 33977ab67b7SOr Gerlitz } 34077ab67b7SOr Gerlitz 3413f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc) 3423f6d08d1SOr Gerlitz { 3433f6d08d1SOr Gerlitz u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn; 3443f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3453f6d08d1SOr Gerlitz int i, ix, sz = MLX5E_INDIR_RQT_SIZE; 3463f6d08d1SOr Gerlitz 3473f6d08d1SOr Gerlitz mlx5e_build_default_indir_rqt(indirection_rqt, sz, 3483f6d08d1SOr Gerlitz hp->num_channels); 3493f6d08d1SOr Gerlitz 3503f6d08d1SOr Gerlitz for (i = 0; i < sz; i++) { 3513f6d08d1SOr Gerlitz ix = i; 352bbeb53b8SAya Levin if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR) 3533f6d08d1SOr Gerlitz ix = mlx5e_bits_invert(i, ilog2(sz)); 3543f6d08d1SOr Gerlitz ix = indirection_rqt[ix]; 3553f6d08d1SOr Gerlitz rqn = hp->pair->rqn[ix]; 3563f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rq_num[i], rqn); 3573f6d08d1SOr Gerlitz } 3583f6d08d1SOr Gerlitz } 3593f6d08d1SOr Gerlitz 3603f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp) 3613f6d08d1SOr Gerlitz { 3623f6d08d1SOr Gerlitz int inlen, err, sz = MLX5E_INDIR_RQT_SIZE; 3633f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3643f6d08d1SOr Gerlitz struct mlx5_core_dev *mdev = priv->mdev; 3653f6d08d1SOr Gerlitz void *rqtc; 3663f6d08d1SOr Gerlitz u32 *in; 3673f6d08d1SOr Gerlitz 3683f6d08d1SOr Gerlitz inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz; 3693f6d08d1SOr Gerlitz in = kvzalloc(inlen, GFP_KERNEL); 3703f6d08d1SOr Gerlitz if (!in) 3713f6d08d1SOr Gerlitz return -ENOMEM; 3723f6d08d1SOr Gerlitz 3733f6d08d1SOr Gerlitz rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context); 3743f6d08d1SOr Gerlitz 3753f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_actual_size, sz); 3763f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_max_size, sz); 3773f6d08d1SOr Gerlitz 3783f6d08d1SOr Gerlitz mlx5e_hairpin_fill_rqt_rqns(hp, rqtc); 3793f6d08d1SOr Gerlitz 3803f6d08d1SOr Gerlitz err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn); 3813f6d08d1SOr Gerlitz if (!err) 3823f6d08d1SOr Gerlitz hp->indir_rqt.enabled = true; 3833f6d08d1SOr Gerlitz 3843f6d08d1SOr Gerlitz kvfree(in); 3853f6d08d1SOr Gerlitz return err; 3863f6d08d1SOr Gerlitz } 3873f6d08d1SOr Gerlitz 3883f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp) 3893f6d08d1SOr Gerlitz { 3903f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3913f6d08d1SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)]; 3923f6d08d1SOr Gerlitz int tt, i, err; 3933f6d08d1SOr Gerlitz void *tirc; 3943f6d08d1SOr Gerlitz 3953f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) { 396d930ac79SAya Levin struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt); 397d930ac79SAya Levin 3983f6d08d1SOr Gerlitz memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in)); 3993f6d08d1SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 4003f6d08d1SOr Gerlitz 4013f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 4023f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT); 4033f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn); 404bbeb53b8SAya Levin mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false); 405bbeb53b8SAya Levin 4063f6d08d1SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, 4073f6d08d1SOr Gerlitz MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]); 4083f6d08d1SOr Gerlitz if (err) { 4093f6d08d1SOr Gerlitz mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err); 4103f6d08d1SOr Gerlitz goto err_destroy_tirs; 4113f6d08d1SOr Gerlitz } 4123f6d08d1SOr Gerlitz } 4133f6d08d1SOr Gerlitz return 0; 4143f6d08d1SOr Gerlitz 4153f6d08d1SOr Gerlitz err_destroy_tirs: 4163f6d08d1SOr Gerlitz for (i = 0; i < tt; i++) 4173f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]); 4183f6d08d1SOr Gerlitz return err; 4193f6d08d1SOr Gerlitz } 4203f6d08d1SOr Gerlitz 4213f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp) 4223f6d08d1SOr Gerlitz { 4233f6d08d1SOr Gerlitz int tt; 4243f6d08d1SOr Gerlitz 4253f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4263f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]); 4273f6d08d1SOr Gerlitz } 4283f6d08d1SOr Gerlitz 4293f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp, 4303f6d08d1SOr Gerlitz struct ttc_params *ttc_params) 4313f6d08d1SOr Gerlitz { 4323f6d08d1SOr Gerlitz struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr; 4333f6d08d1SOr Gerlitz int tt; 4343f6d08d1SOr Gerlitz 4353f6d08d1SOr Gerlitz memset(ttc_params, 0, sizeof(*ttc_params)); 4363f6d08d1SOr Gerlitz 4373f6d08d1SOr Gerlitz ttc_params->any_tt_tirn = hp->tirn; 4383f6d08d1SOr Gerlitz 4393f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4403f6d08d1SOr Gerlitz ttc_params->indir_tirn[tt] = hp->indir_tirn[tt]; 4413f6d08d1SOr Gerlitz 4423f6d08d1SOr Gerlitz ft_attr->max_fte = MLX5E_NUM_TT; 4433f6d08d1SOr Gerlitz ft_attr->level = MLX5E_TC_TTC_FT_LEVEL; 4443f6d08d1SOr Gerlitz ft_attr->prio = MLX5E_TC_PRIO; 4453f6d08d1SOr Gerlitz } 4463f6d08d1SOr Gerlitz 4473f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp) 4483f6d08d1SOr Gerlitz { 4493f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4503f6d08d1SOr Gerlitz struct ttc_params ttc_params; 4513f6d08d1SOr Gerlitz int err; 4523f6d08d1SOr Gerlitz 4533f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_rqt(hp); 4543f6d08d1SOr Gerlitz if (err) 4553f6d08d1SOr Gerlitz return err; 4563f6d08d1SOr Gerlitz 4573f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_tirs(hp); 4583f6d08d1SOr Gerlitz if (err) 4593f6d08d1SOr Gerlitz goto err_create_indirect_tirs; 4603f6d08d1SOr Gerlitz 4613f6d08d1SOr Gerlitz mlx5e_hairpin_set_ttc_params(hp, &ttc_params); 4623f6d08d1SOr Gerlitz err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc); 4633f6d08d1SOr Gerlitz if (err) 4643f6d08d1SOr Gerlitz goto err_create_ttc_table; 4653f6d08d1SOr Gerlitz 4663f6d08d1SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n", 4673f6d08d1SOr Gerlitz hp->num_channels, hp->ttc.ft.t->id); 4683f6d08d1SOr Gerlitz 4693f6d08d1SOr Gerlitz return 0; 4703f6d08d1SOr Gerlitz 4713f6d08d1SOr Gerlitz err_create_ttc_table: 4723f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4733f6d08d1SOr Gerlitz err_create_indirect_tirs: 4743f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4753f6d08d1SOr Gerlitz 4763f6d08d1SOr Gerlitz return err; 4773f6d08d1SOr Gerlitz } 4783f6d08d1SOr Gerlitz 4793f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp) 4803f6d08d1SOr Gerlitz { 4813f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4823f6d08d1SOr Gerlitz 4833f6d08d1SOr Gerlitz mlx5e_destroy_ttc_table(priv, &hp->ttc); 4843f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4853f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4863f6d08d1SOr Gerlitz } 4873f6d08d1SOr Gerlitz 48877ab67b7SOr Gerlitz static struct mlx5e_hairpin * 48977ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params, 49077ab67b7SOr Gerlitz int peer_ifindex) 49177ab67b7SOr Gerlitz { 49277ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev, *peer_mdev; 49377ab67b7SOr Gerlitz struct mlx5e_hairpin *hp; 49477ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 49577ab67b7SOr Gerlitz int err; 49677ab67b7SOr Gerlitz 49777ab67b7SOr Gerlitz hp = kzalloc(sizeof(*hp), GFP_KERNEL); 49877ab67b7SOr Gerlitz if (!hp) 49977ab67b7SOr Gerlitz return ERR_PTR(-ENOMEM); 50077ab67b7SOr Gerlitz 50177ab67b7SOr Gerlitz func_mdev = priv->mdev; 50277ab67b7SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 50377ab67b7SOr Gerlitz 50477ab67b7SOr Gerlitz pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params); 50577ab67b7SOr Gerlitz if (IS_ERR(pair)) { 50677ab67b7SOr Gerlitz err = PTR_ERR(pair); 50777ab67b7SOr Gerlitz goto create_pair_err; 50877ab67b7SOr Gerlitz } 50977ab67b7SOr Gerlitz hp->pair = pair; 51077ab67b7SOr Gerlitz hp->func_mdev = func_mdev; 5113f6d08d1SOr Gerlitz hp->func_priv = priv; 5123f6d08d1SOr Gerlitz hp->num_channels = params->num_channels; 51377ab67b7SOr Gerlitz 51477ab67b7SOr Gerlitz err = mlx5e_hairpin_create_transport(hp); 51577ab67b7SOr Gerlitz if (err) 51677ab67b7SOr Gerlitz goto create_transport_err; 51777ab67b7SOr Gerlitz 5183f6d08d1SOr Gerlitz if (hp->num_channels > 1) { 5193f6d08d1SOr Gerlitz err = mlx5e_hairpin_rss_init(hp); 5203f6d08d1SOr Gerlitz if (err) 5213f6d08d1SOr Gerlitz goto rss_init_err; 5223f6d08d1SOr Gerlitz } 5233f6d08d1SOr Gerlitz 52477ab67b7SOr Gerlitz return hp; 52577ab67b7SOr Gerlitz 5263f6d08d1SOr Gerlitz rss_init_err: 5273f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 52877ab67b7SOr Gerlitz create_transport_err: 52977ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 53077ab67b7SOr Gerlitz create_pair_err: 53177ab67b7SOr Gerlitz kfree(hp); 53277ab67b7SOr Gerlitz return ERR_PTR(err); 53377ab67b7SOr Gerlitz } 53477ab67b7SOr Gerlitz 53577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp) 53677ab67b7SOr Gerlitz { 5373f6d08d1SOr Gerlitz if (hp->num_channels > 1) 5383f6d08d1SOr Gerlitz mlx5e_hairpin_rss_cleanup(hp); 53977ab67b7SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 54077ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 54177ab67b7SOr Gerlitz kvfree(hp); 54277ab67b7SOr Gerlitz } 54377ab67b7SOr Gerlitz 544106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio) 545106be53bSOr Gerlitz { 546106be53bSOr Gerlitz return (peer_vhca_id << 16 | prio); 547106be53bSOr Gerlitz } 548106be53bSOr Gerlitz 5495c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv, 550106be53bSOr Gerlitz u16 peer_vhca_id, u8 prio) 5515c65c564SOr Gerlitz { 5525c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 553106be53bSOr Gerlitz u32 hash_key = hash_hairpin_info(peer_vhca_id, prio); 5545c65c564SOr Gerlitz 5555c65c564SOr Gerlitz hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe, 556106be53bSOr Gerlitz hairpin_hlist, hash_key) { 557106be53bSOr Gerlitz if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) 5585c65c564SOr Gerlitz return hpe; 5595c65c564SOr Gerlitz } 5605c65c564SOr Gerlitz 5615c65c564SOr Gerlitz return NULL; 5625c65c564SOr Gerlitz } 5635c65c564SOr Gerlitz 564106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8 565106be53bSOr Gerlitz 566106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv, 567e98bedf5SEli Britstein struct mlx5_flow_spec *spec, u8 *match_prio, 568e98bedf5SEli Britstein struct netlink_ext_ack *extack) 569106be53bSOr Gerlitz { 570106be53bSOr Gerlitz void *headers_c, *headers_v; 571106be53bSOr Gerlitz u8 prio_val, prio_mask = 0; 572106be53bSOr Gerlitz bool vlan_present; 573106be53bSOr Gerlitz 574106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB 575106be53bSOr Gerlitz if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) { 576e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 577e98bedf5SEli Britstein "only PCP trust state supported for hairpin"); 578106be53bSOr Gerlitz return -EOPNOTSUPP; 579106be53bSOr Gerlitz } 580106be53bSOr Gerlitz #endif 581106be53bSOr Gerlitz headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers); 582106be53bSOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 583106be53bSOr Gerlitz 584106be53bSOr Gerlitz vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag); 585106be53bSOr Gerlitz if (vlan_present) { 586106be53bSOr Gerlitz prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 587106be53bSOr Gerlitz prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 588106be53bSOr Gerlitz } 589106be53bSOr Gerlitz 590106be53bSOr Gerlitz if (!vlan_present || !prio_mask) { 591106be53bSOr Gerlitz prio_val = UNKNOWN_MATCH_PRIO; 592106be53bSOr Gerlitz } else if (prio_mask != 0x7) { 593e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 594e98bedf5SEli Britstein "masked priority match not supported for hairpin"); 595106be53bSOr Gerlitz return -EOPNOTSUPP; 596106be53bSOr Gerlitz } 597106be53bSOr Gerlitz 598106be53bSOr Gerlitz *match_prio = prio_val; 599106be53bSOr Gerlitz return 0; 600106be53bSOr Gerlitz } 601106be53bSOr Gerlitz 6025c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv, 6035c65c564SOr Gerlitz struct mlx5e_tc_flow *flow, 604e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 605e98bedf5SEli Britstein struct netlink_ext_ack *extack) 6065c65c564SOr Gerlitz { 60798b66cb1SEli Britstein int peer_ifindex = parse_attr->mirred_ifindex[0]; 6085c65c564SOr Gerlitz struct mlx5_hairpin_params params; 609d8822868SOr Gerlitz struct mlx5_core_dev *peer_mdev; 6105c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 6115c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 6123f6d08d1SOr Gerlitz u64 link_speed64; 6133f6d08d1SOr Gerlitz u32 link_speed; 614106be53bSOr Gerlitz u8 match_prio; 615d8822868SOr Gerlitz u16 peer_id; 6165c65c564SOr Gerlitz int err; 6175c65c564SOr Gerlitz 618d8822868SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 619d8822868SOr Gerlitz if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) { 620e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported"); 6215c65c564SOr Gerlitz return -EOPNOTSUPP; 6225c65c564SOr Gerlitz } 6235c65c564SOr Gerlitz 624d8822868SOr Gerlitz peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 625e98bedf5SEli Britstein err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio, 626e98bedf5SEli Britstein extack); 627106be53bSOr Gerlitz if (err) 628106be53bSOr Gerlitz return err; 629106be53bSOr Gerlitz hpe = mlx5e_hairpin_get(priv, peer_id, match_prio); 6305c65c564SOr Gerlitz if (hpe) 6315c65c564SOr Gerlitz goto attach_flow; 6325c65c564SOr Gerlitz 6335c65c564SOr Gerlitz hpe = kzalloc(sizeof(*hpe), GFP_KERNEL); 6345c65c564SOr Gerlitz if (!hpe) 6355c65c564SOr Gerlitz return -ENOMEM; 6365c65c564SOr Gerlitz 6375c65c564SOr Gerlitz INIT_LIST_HEAD(&hpe->flows); 638d8822868SOr Gerlitz hpe->peer_vhca_id = peer_id; 639106be53bSOr Gerlitz hpe->prio = match_prio; 6405c65c564SOr Gerlitz 6415c65c564SOr Gerlitz params.log_data_size = 15; 6425c65c564SOr Gerlitz params.log_data_size = min_t(u8, params.log_data_size, 6435c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz)); 6445c65c564SOr Gerlitz params.log_data_size = max_t(u8, params.log_data_size, 6455c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz)); 6465c65c564SOr Gerlitz 647eb9180f7SOr Gerlitz params.log_num_packets = params.log_data_size - 648eb9180f7SOr Gerlitz MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev); 649eb9180f7SOr Gerlitz params.log_num_packets = min_t(u8, params.log_num_packets, 650eb9180f7SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets)); 651eb9180f7SOr Gerlitz 652eb9180f7SOr Gerlitz params.q_counter = priv->q_counter; 6533f6d08d1SOr Gerlitz /* set hairpin pair per each 50Gbs share of the link */ 6542c81bfd5SHuy Nguyen mlx5e_port_max_linkspeed(priv->mdev, &link_speed); 6553f6d08d1SOr Gerlitz link_speed = max_t(u32, link_speed, 50000); 6563f6d08d1SOr Gerlitz link_speed64 = link_speed; 6573f6d08d1SOr Gerlitz do_div(link_speed64, 50000); 6583f6d08d1SOr Gerlitz params.num_channels = link_speed64; 6593f6d08d1SOr Gerlitz 6605c65c564SOr Gerlitz hp = mlx5e_hairpin_create(priv, ¶ms, peer_ifindex); 6615c65c564SOr Gerlitz if (IS_ERR(hp)) { 6625c65c564SOr Gerlitz err = PTR_ERR(hp); 6635c65c564SOr Gerlitz goto create_hairpin_err; 6645c65c564SOr Gerlitz } 6655c65c564SOr Gerlitz 666eb9180f7SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n", 66727b942fbSParav Pandit hp->tirn, hp->pair->rqn[0], 66827b942fbSParav Pandit dev_name(hp->pair->peer_mdev->device), 669eb9180f7SOr Gerlitz hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets); 6705c65c564SOr Gerlitz 6715c65c564SOr Gerlitz hpe->hp = hp; 672106be53bSOr Gerlitz hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist, 673106be53bSOr Gerlitz hash_hairpin_info(peer_id, match_prio)); 6745c65c564SOr Gerlitz 6755c65c564SOr Gerlitz attach_flow: 6763f6d08d1SOr Gerlitz if (hpe->hp->num_channels > 1) { 6773f6d08d1SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS; 6783f6d08d1SOr Gerlitz flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t; 6793f6d08d1SOr Gerlitz } else { 6805c65c564SOr Gerlitz flow->nic_attr->hairpin_tirn = hpe->hp->tirn; 6813f6d08d1SOr Gerlitz } 6825c65c564SOr Gerlitz list_add(&flow->hairpin, &hpe->flows); 6833f6d08d1SOr Gerlitz 6845c65c564SOr Gerlitz return 0; 6855c65c564SOr Gerlitz 6865c65c564SOr Gerlitz create_hairpin_err: 6875c65c564SOr Gerlitz kfree(hpe); 6885c65c564SOr Gerlitz return err; 6895c65c564SOr Gerlitz } 6905c65c564SOr Gerlitz 6915c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv, 6925c65c564SOr Gerlitz struct mlx5e_tc_flow *flow) 6935c65c564SOr Gerlitz { 6945c65c564SOr Gerlitz struct list_head *next = flow->hairpin.next; 6955c65c564SOr Gerlitz 6965c65c564SOr Gerlitz list_del(&flow->hairpin); 6975c65c564SOr Gerlitz 6985c65c564SOr Gerlitz /* no more hairpin flows for us, release the hairpin pair */ 6995c65c564SOr Gerlitz if (list_empty(next)) { 7005c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 7015c65c564SOr Gerlitz 7025c65c564SOr Gerlitz hpe = list_entry(next, struct mlx5e_hairpin_entry, flows); 7035c65c564SOr Gerlitz 7045c65c564SOr Gerlitz netdev_dbg(priv->netdev, "del hairpin: peer %s\n", 70527b942fbSParav Pandit dev_name(hpe->hp->pair->peer_mdev->device)); 7065c65c564SOr Gerlitz 7075c65c564SOr Gerlitz mlx5e_hairpin_destroy(hpe->hp); 7085c65c564SOr Gerlitz hash_del(&hpe->hairpin_hlist); 7095c65c564SOr Gerlitz kfree(hpe); 7105c65c564SOr Gerlitz } 7115c65c564SOr Gerlitz } 7125c65c564SOr Gerlitz 713c83954abSRabie Loulou static int 71474491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 71517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 716e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 717e98bedf5SEli Britstein struct netlink_ext_ack *extack) 718e8f887acSAmir Vadai { 719aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 720aad7e08dSAmir Vadai struct mlx5_core_dev *dev = priv->mdev; 7215c65c564SOr Gerlitz struct mlx5_flow_destination dest[2] = {}; 72266958ed9SHadar Hen Zion struct mlx5_flow_act flow_act = { 7233bc4b7bfSOr Gerlitz .action = attr->action, 7243bc4b7bfSOr Gerlitz .flow_tag = attr->flow_tag, 72560786f09SMark Bloch .reformat_id = 0, 72642f7ad67SPaul Blakey .flags = FLOW_ACT_HAS_TAG | FLOW_ACT_NO_APPEND, 72766958ed9SHadar Hen Zion }; 728aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 729e8f887acSAmir Vadai bool table_created = false; 7305c65c564SOr Gerlitz int err, dest_ix = 0; 731e8f887acSAmir Vadai 7325c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) { 733e98bedf5SEli Britstein err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack); 7345c65c564SOr Gerlitz if (err) { 7355c65c564SOr Gerlitz goto err_add_hairpin_flow; 7365c65c564SOr Gerlitz } 7373f6d08d1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) { 7383f6d08d1SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7393f6d08d1SOr Gerlitz dest[dest_ix].ft = attr->hairpin_ft; 7403f6d08d1SOr Gerlitz } else { 7415c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR; 7425c65c564SOr Gerlitz dest[dest_ix].tir_num = attr->hairpin_tirn; 7433f6d08d1SOr Gerlitz } 7443f6d08d1SOr Gerlitz dest_ix++; 7453f6d08d1SOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 7465c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7475c65c564SOr Gerlitz dest[dest_ix].ft = priv->fs.vlan.ft.t; 7485c65c564SOr Gerlitz dest_ix++; 7495c65c564SOr Gerlitz } 750aad7e08dSAmir Vadai 7515c65c564SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 7525c65c564SOr Gerlitz counter = mlx5_fc_create(dev, true); 7535c65c564SOr Gerlitz if (IS_ERR(counter)) { 754c83954abSRabie Loulou err = PTR_ERR(counter); 7555c65c564SOr Gerlitz goto err_fc_create; 7565c65c564SOr Gerlitz } 7575c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 758171c7625SMark Bloch dest[dest_ix].counter_id = mlx5_fc_id(counter); 7595c65c564SOr Gerlitz dest_ix++; 760b8aee822SMark Bloch attr->counter = counter; 761aad7e08dSAmir Vadai } 762aad7e08dSAmir Vadai 7632f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 7643099eb5aSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 765d7e75a32SOr Gerlitz flow_act.modify_id = attr->mod_hdr_id; 7662f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 767c83954abSRabie Loulou if (err) 7682f4fe4caSOr Gerlitz goto err_create_mod_hdr_id; 7692f4fe4caSOr Gerlitz } 7702f4fe4caSOr Gerlitz 771acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 77221b9c144SOr Gerlitz int tc_grp_size, tc_tbl_size; 77321b9c144SOr Gerlitz u32 max_flow_counter; 77421b9c144SOr Gerlitz 77521b9c144SOr Gerlitz max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) | 77621b9c144SOr Gerlitz MLX5_CAP_GEN(dev, max_flow_counter_15_0); 77721b9c144SOr Gerlitz 77821b9c144SOr Gerlitz tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE); 77921b9c144SOr Gerlitz 78021b9c144SOr Gerlitz tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS, 78121b9c144SOr Gerlitz BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size))); 78221b9c144SOr Gerlitz 783acff797cSMaor Gottlieb priv->fs.tc.t = 784acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 785acff797cSMaor Gottlieb MLX5E_TC_PRIO, 78621b9c144SOr Gerlitz tc_tbl_size, 787acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 7883f6d08d1SOr Gerlitz MLX5E_TC_FT_LEVEL, 0); 789acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 790e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 791e98bedf5SEli Britstein "Failed to create tc offload table\n"); 792e8f887acSAmir Vadai netdev_err(priv->netdev, 793e8f887acSAmir Vadai "Failed to create tc offload table\n"); 794c83954abSRabie Loulou err = PTR_ERR(priv->fs.tc.t); 795aad7e08dSAmir Vadai goto err_create_ft; 796e8f887acSAmir Vadai } 797e8f887acSAmir Vadai 798e8f887acSAmir Vadai table_created = true; 799e8f887acSAmir Vadai } 800e8f887acSAmir Vadai 80138aa51c1SOr Gerlitz if (attr->match_level != MLX5_MATCH_NONE) 802d4a18e16SYevgeny Kliteynik parse_attr->spec.match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS; 80338aa51c1SOr Gerlitz 804c83954abSRabie Loulou flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 8055c65c564SOr Gerlitz &flow_act, dest, dest_ix); 806e8f887acSAmir Vadai 807c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 808c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 809aad7e08dSAmir Vadai goto err_add_rule; 810c83954abSRabie Loulou } 811aad7e08dSAmir Vadai 812c83954abSRabie Loulou return 0; 813aad7e08dSAmir Vadai 814aad7e08dSAmir Vadai err_add_rule: 815aad7e08dSAmir Vadai if (table_created) { 816acff797cSMaor Gottlieb mlx5_destroy_flow_table(priv->fs.tc.t); 817acff797cSMaor Gottlieb priv->fs.tc.t = NULL; 818e8f887acSAmir Vadai } 819aad7e08dSAmir Vadai err_create_ft: 8202f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8213099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8222f4fe4caSOr Gerlitz err_create_mod_hdr_id: 823aad7e08dSAmir Vadai mlx5_fc_destroy(dev, counter); 8245c65c564SOr Gerlitz err_fc_create: 8255c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8265c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 8275c65c564SOr Gerlitz err_add_hairpin_flow: 828c83954abSRabie Loulou return err; 829e8f887acSAmir Vadai } 830e8f887acSAmir Vadai 831d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 832d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 833d85cdccbSOr Gerlitz { 834513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 835d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 836d85cdccbSOr Gerlitz 837b8aee822SMark Bloch counter = attr->counter; 838e4ad91f2SChris Mi mlx5_del_flow_rules(flow->rule[0]); 839d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 840d85cdccbSOr Gerlitz 841d9ee0491SOr Gerlitz if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD) && priv->fs.tc.t) { 842d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 843d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 844d85cdccbSOr Gerlitz } 8452f4fe4caSOr Gerlitz 846513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8473099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8485c65c564SOr Gerlitz 8495c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8505c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 851d85cdccbSOr Gerlitz } 852d85cdccbSOr Gerlitz 853aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 8548c4dc42bSEli Britstein struct mlx5e_tc_flow *flow, int out_index); 855aa0cbbaeSOr Gerlitz 8563c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv, 857e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 858733d4f36SRoi Dayan struct net_device *mirred_dev, 859733d4f36SRoi Dayan int out_index, 8608c4dc42bSEli Britstein struct netlink_ext_ack *extack, 8610ad060eeSRoi Dayan struct net_device **encap_dev, 8620ad060eeSRoi Dayan bool *encap_valid); 8633c37745eSOr Gerlitz 8646d2a3ed0SOr Gerlitz static struct mlx5_flow_handle * 8656d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw, 8666d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 8676d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec, 8686d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 8696d2a3ed0SOr Gerlitz { 8706d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 8716d2a3ed0SOr Gerlitz 8726d2a3ed0SOr Gerlitz rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr); 8736d2a3ed0SOr Gerlitz if (IS_ERR(rule)) 8746d2a3ed0SOr Gerlitz return rule; 8756d2a3ed0SOr Gerlitz 876e85e02baSEli Britstein if (attr->split_count) { 8776d2a3ed0SOr Gerlitz flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr); 8786d2a3ed0SOr Gerlitz if (IS_ERR(flow->rule[1])) { 8796d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, rule, attr); 8806d2a3ed0SOr Gerlitz return flow->rule[1]; 8816d2a3ed0SOr Gerlitz } 8826d2a3ed0SOr Gerlitz } 8836d2a3ed0SOr Gerlitz 8846d2a3ed0SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 8856d2a3ed0SOr Gerlitz return rule; 8866d2a3ed0SOr Gerlitz } 8876d2a3ed0SOr Gerlitz 8886d2a3ed0SOr Gerlitz static void 8896d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw, 8906d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 8916d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 8926d2a3ed0SOr Gerlitz { 8936d2a3ed0SOr Gerlitz flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 8946d2a3ed0SOr Gerlitz 895e85e02baSEli Britstein if (attr->split_count) 8966d2a3ed0SOr Gerlitz mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr); 8976d2a3ed0SOr Gerlitz 8986d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 8996d2a3ed0SOr Gerlitz } 9006d2a3ed0SOr Gerlitz 9015dbe906fSPaul Blakey static struct mlx5_flow_handle * 9025dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw, 9035dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 9045dbe906fSPaul Blakey struct mlx5_flow_spec *spec, 9055dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 9065dbe906fSPaul Blakey { 9075dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 9085dbe906fSPaul Blakey 9095dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 910154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 9112be09de7SDavid S. Miller slow_attr->split_count = 0; 912154e62abSOr Gerlitz slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN; 9135dbe906fSPaul Blakey 9145dbe906fSPaul Blakey rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr); 9155dbe906fSPaul Blakey if (!IS_ERR(rule)) 9165dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_SLOW; 9175dbe906fSPaul Blakey 9185dbe906fSPaul Blakey return rule; 9195dbe906fSPaul Blakey } 9205dbe906fSPaul Blakey 9215dbe906fSPaul Blakey static void 9225dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw, 9235dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 9245dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 9255dbe906fSPaul Blakey { 9265dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 927154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 9282be09de7SDavid S. Miller slow_attr->split_count = 0; 929154e62abSOr Gerlitz slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN; 9305dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr); 9315dbe906fSPaul Blakey flow->flags &= ~MLX5E_TC_FLOW_SLOW; 9325dbe906fSPaul Blakey } 9335dbe906fSPaul Blakey 934b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow) 935b4a23329SRoi Dayan { 936b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *uplink_priv; 937b4a23329SRoi Dayan struct mlx5e_rep_priv *rpriv; 938b4a23329SRoi Dayan struct mlx5_eswitch *esw; 939b4a23329SRoi Dayan 940b4a23329SRoi Dayan esw = flow->priv->mdev->priv.eswitch; 941b4a23329SRoi Dayan rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 942b4a23329SRoi Dayan uplink_priv = &rpriv->uplink_priv; 943b4a23329SRoi Dayan 944b4a23329SRoi Dayan flow->flags |= MLX5E_TC_FLOW_NOT_READY; 945b4a23329SRoi Dayan list_add_tail(&flow->unready, &uplink_priv->unready_flows); 946b4a23329SRoi Dayan } 947b4a23329SRoi Dayan 948b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow) 949b4a23329SRoi Dayan { 950b4a23329SRoi Dayan list_del(&flow->unready); 951b4a23329SRoi Dayan flow->flags &= ~MLX5E_TC_FLOW_NOT_READY; 952b4a23329SRoi Dayan } 953b4a23329SRoi Dayan 954c83954abSRabie Loulou static int 95574491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 956e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 957e98bedf5SEli Britstein struct netlink_ext_ack *extack) 958adb4c123SOr Gerlitz { 959adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 960bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 961aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 9627040632dSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 963bf07aa73SPaul Blakey u16 max_prio = mlx5_eswitch_get_prio_range(esw); 9643c37745eSOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 965b8aee822SMark Bloch struct mlx5_fc *counter = NULL; 9663c37745eSOr Gerlitz struct mlx5e_rep_priv *rpriv; 9673c37745eSOr Gerlitz struct mlx5e_priv *out_priv; 9680ad060eeSRoi Dayan bool encap_valid = true; 9690ad060eeSRoi Dayan int err = 0; 970f493f155SEli Britstein int out_index; 9718b32580dSOr Gerlitz 972d14f6f2aSOr Gerlitz if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) { 973d14f6f2aSOr Gerlitz NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW"); 974d14f6f2aSOr Gerlitz return -EOPNOTSUPP; 975d14f6f2aSOr Gerlitz } 976e52c2802SPaul Blakey 977bf07aa73SPaul Blakey if (attr->chain > max_chain) { 978bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested chain is out of supported range"); 979bf07aa73SPaul Blakey err = -EOPNOTSUPP; 980bf07aa73SPaul Blakey goto err_max_prio_chain; 981bf07aa73SPaul Blakey } 982bf07aa73SPaul Blakey 983bf07aa73SPaul Blakey if (attr->prio > max_prio) { 984bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested priority is out of supported range"); 985bf07aa73SPaul Blakey err = -EOPNOTSUPP; 986bf07aa73SPaul Blakey goto err_max_prio_chain; 987bf07aa73SPaul Blakey } 988bf07aa73SPaul Blakey 989f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) { 9908c4dc42bSEli Britstein int mirred_ifindex; 9918c4dc42bSEli Britstein 992f493f155SEli Britstein if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)) 993f493f155SEli Britstein continue; 994f493f155SEli Britstein 9957040632dSTonghao Zhang mirred_ifindex = parse_attr->mirred_ifindex[out_index]; 9963c37745eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), 9978c4dc42bSEli Britstein mirred_ifindex); 998733d4f36SRoi Dayan err = mlx5e_attach_encap(priv, flow, out_dev, out_index, 9990ad060eeSRoi Dayan extack, &encap_dev, &encap_valid); 10000ad060eeSRoi Dayan if (err) 10013c37745eSOr Gerlitz goto err_attach_encap; 10020ad060eeSRoi Dayan 10033c37745eSOr Gerlitz out_priv = netdev_priv(encap_dev); 10043c37745eSOr Gerlitz rpriv = out_priv->ppriv; 10051cc26d74SEli Britstein attr->dests[out_index].rep = rpriv->rep; 10061cc26d74SEli Britstein attr->dests[out_index].mdev = out_priv->mdev; 10073c37745eSOr Gerlitz } 10083c37745eSOr Gerlitz 10098b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 1010c83954abSRabie Loulou if (err) 1011aa0cbbaeSOr Gerlitz goto err_add_vlan; 1012adb4c123SOr Gerlitz 1013d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 10141a9527bbSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 1015d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1016c83954abSRabie Loulou if (err) 1017d7e75a32SOr Gerlitz goto err_mod_hdr; 1018d7e75a32SOr Gerlitz } 1019d7e75a32SOr Gerlitz 1020b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 1021f9392795SShahar Klein counter = mlx5_fc_create(attr->counter_dev, true); 1022b8aee822SMark Bloch if (IS_ERR(counter)) { 1023c83954abSRabie Loulou err = PTR_ERR(counter); 1024b8aee822SMark Bloch goto err_create_counter; 1025b8aee822SMark Bloch } 1026b8aee822SMark Bloch 1027b8aee822SMark Bloch attr->counter = counter; 1028b8aee822SMark Bloch } 1029b8aee822SMark Bloch 10300ad060eeSRoi Dayan /* we get here if one of the following takes place: 10310ad060eeSRoi Dayan * (1) there's no error 10320ad060eeSRoi Dayan * (2) there's an encap action and we don't have valid neigh 10333c37745eSOr Gerlitz */ 10340ad060eeSRoi Dayan if (!encap_valid) { 10355dbe906fSPaul Blakey /* continue with goto slow path rule instead */ 10365dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 10375dbe906fSPaul Blakey 10385dbe906fSPaul Blakey flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr); 10395dbe906fSPaul Blakey } else { 10406d2a3ed0SOr Gerlitz flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr); 10415dbe906fSPaul Blakey } 10425dbe906fSPaul Blakey 1043c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 1044c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 1045aa0cbbaeSOr Gerlitz goto err_add_rule; 1046c83954abSRabie Loulou } 1047c83954abSRabie Loulou 10485dbe906fSPaul Blakey return 0; 1049aa0cbbaeSOr Gerlitz 1050aa0cbbaeSOr Gerlitz err_add_rule: 1051f9392795SShahar Klein mlx5_fc_destroy(attr->counter_dev, counter); 1052b8aee822SMark Bloch err_create_counter: 1053513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 10541a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 1055d7e75a32SOr Gerlitz err_mod_hdr: 1056aa0cbbaeSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 1057aa0cbbaeSOr Gerlitz err_add_vlan: 1058f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 10598c4dc42bSEli Britstein if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) 10608c4dc42bSEli Britstein mlx5e_detach_encap(priv, flow, out_index); 10613c37745eSOr Gerlitz err_attach_encap: 1062bf07aa73SPaul Blakey err_max_prio_chain: 1063c83954abSRabie Loulou return err; 1064aa0cbbaeSOr Gerlitz } 1065d85cdccbSOr Gerlitz 1066d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 1067d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1068d85cdccbSOr Gerlitz { 1069d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1070d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 10715dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 1072f493f155SEli Britstein int out_index; 1073d85cdccbSOr Gerlitz 1074ef06c9eeSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_NOT_READY) { 1075b4a23329SRoi Dayan remove_unready_flow(flow); 1076ef06c9eeSRoi Dayan kvfree(attr->parse_attr); 1077ef06c9eeSRoi Dayan return; 1078ef06c9eeSRoi Dayan } 1079ef06c9eeSRoi Dayan 10805dbe906fSPaul Blakey if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 10815dbe906fSPaul Blakey if (flow->flags & MLX5E_TC_FLOW_SLOW) 10825dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 10835dbe906fSPaul Blakey else 10845dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, attr); 10855dbe906fSPaul Blakey } 1086d85cdccbSOr Gerlitz 1087513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 1088d85cdccbSOr Gerlitz 1089f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 10908c4dc42bSEli Britstein if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) 10918c4dc42bSEli Britstein mlx5e_detach_encap(priv, flow, out_index); 1092f493f155SEli Britstein kvfree(attr->parse_attr); 1093d7e75a32SOr Gerlitz 1094513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 10951a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 1096b8aee822SMark Bloch 1097b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) 1098f9392795SShahar Klein mlx5_fc_destroy(attr->counter_dev, attr->counter); 1099d85cdccbSOr Gerlitz } 1100d85cdccbSOr Gerlitz 1101232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 1102232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 1103232c0013SHadar Hen Zion { 11043c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 11055dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr, *esw_attr; 11066d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 11076d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec; 110879baaec7SEli Britstein struct encap_flow_item *efi; 1109232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 1110232c0013SHadar Hen Zion int err; 1111232c0013SHadar Hen Zion 111254c177caSOz Shlomo err = mlx5_packet_reformat_alloc(priv->mdev, 111354c177caSOz Shlomo e->reformat_type, 1114232c0013SHadar Hen Zion e->encap_size, e->encap_header, 111531ca3648SMark Bloch MLX5_FLOW_NAMESPACE_FDB, 1116232c0013SHadar Hen Zion &e->encap_id); 1117232c0013SHadar Hen Zion if (err) { 1118232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n", 1119232c0013SHadar Hen Zion err); 1120232c0013SHadar Hen Zion return; 1121232c0013SHadar Hen Zion } 1122232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 1123f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 1124232c0013SHadar Hen Zion 112579baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 11268c4dc42bSEli Britstein bool all_flow_encaps_valid = true; 11278c4dc42bSEli Britstein int i; 11288c4dc42bSEli Britstein 112979baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]); 11303c37745eSOr Gerlitz esw_attr = flow->esw_attr; 11316d2a3ed0SOr Gerlitz spec = &esw_attr->parse_attr->spec; 11326d2a3ed0SOr Gerlitz 11338c4dc42bSEli Britstein esw_attr->dests[efi->index].encap_id = e->encap_id; 11348c4dc42bSEli Britstein esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 11358c4dc42bSEli Britstein /* Flow can be associated with multiple encap entries. 11368c4dc42bSEli Britstein * Before offloading the flow verify that all of them have 11378c4dc42bSEli Britstein * a valid neighbour. 11388c4dc42bSEli Britstein */ 11398c4dc42bSEli Britstein for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) { 11408c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP)) 11418c4dc42bSEli Britstein continue; 11428c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) { 11438c4dc42bSEli Britstein all_flow_encaps_valid = false; 11448c4dc42bSEli Britstein break; 11458c4dc42bSEli Britstein } 11468c4dc42bSEli Britstein } 11478c4dc42bSEli Britstein /* Do not offload flows with unresolved neighbors */ 11488c4dc42bSEli Britstein if (!all_flow_encaps_valid) 11498c4dc42bSEli Britstein continue; 11505dbe906fSPaul Blakey /* update from slow path rule to encap rule */ 11516d2a3ed0SOr Gerlitz rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr); 11526d2a3ed0SOr Gerlitz if (IS_ERR(rule)) { 11536d2a3ed0SOr Gerlitz err = PTR_ERR(rule); 1154232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 1155232c0013SHadar Hen Zion err); 1156232c0013SHadar Hen Zion continue; 1157232c0013SHadar Hen Zion } 11585dbe906fSPaul Blakey 11595dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 11605dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */ 11616d2a3ed0SOr Gerlitz flow->rule[0] = rule; 1162232c0013SHadar Hen Zion } 1163232c0013SHadar Hen Zion } 1164232c0013SHadar Hen Zion 1165232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 1166232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 1167232c0013SHadar Hen Zion { 11683c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 11695dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 11705dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 11715dbe906fSPaul Blakey struct mlx5_flow_spec *spec; 117279baaec7SEli Britstein struct encap_flow_item *efi; 1173232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 11745dbe906fSPaul Blakey int err; 1175232c0013SHadar Hen Zion 117679baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 117779baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]); 11785dbe906fSPaul Blakey spec = &flow->esw_attr->parse_attr->spec; 11795dbe906fSPaul Blakey 11805dbe906fSPaul Blakey /* update from encap rule to slow path rule */ 11815dbe906fSPaul Blakey rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr); 11828c4dc42bSEli Britstein /* mark the flow's encap dest as non-valid */ 11838c4dc42bSEli Britstein flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID; 11845dbe906fSPaul Blakey 11855dbe906fSPaul Blakey if (IS_ERR(rule)) { 11865dbe906fSPaul Blakey err = PTR_ERR(rule); 11875dbe906fSPaul Blakey mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n", 11885dbe906fSPaul Blakey err); 11895dbe906fSPaul Blakey continue; 11905dbe906fSPaul Blakey } 11915dbe906fSPaul Blakey 11926d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr); 11935dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */ 11945dbe906fSPaul Blakey flow->rule[0] = rule; 1195232c0013SHadar Hen Zion } 1196232c0013SHadar Hen Zion 119761c806daSOr Gerlitz /* we know that the encap is valid */ 1198232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 119960786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1200232c0013SHadar Hen Zion } 1201232c0013SHadar Hen Zion 1202b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow) 1203b8aee822SMark Bloch { 1204b8aee822SMark Bloch if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 1205b8aee822SMark Bloch return flow->esw_attr->counter; 1206b8aee822SMark Bloch else 1207b8aee822SMark Bloch return flow->nic_attr->counter; 1208b8aee822SMark Bloch } 1209b8aee822SMark Bloch 1210f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 1211f6dfb4c3SHadar Hen Zion { 1212f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 1213f6dfb4c3SHadar Hen Zion u64 bytes, packets, lastuse = 0; 1214f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 1215f6dfb4c3SHadar Hen Zion struct mlx5e_encap_entry *e; 1216f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 1217f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 1218f6dfb4c3SHadar Hen Zion bool neigh_used = false; 1219f6dfb4c3SHadar Hen Zion struct neighbour *n; 1220f6dfb4c3SHadar Hen Zion 1221f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 1222f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 1223f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 1224f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 1225423c9db2SOr Gerlitz tbl = &nd_tbl; 1226f6dfb4c3SHadar Hen Zion #endif 1227f6dfb4c3SHadar Hen Zion else 1228f6dfb4c3SHadar Hen Zion return; 1229f6dfb4c3SHadar Hen Zion 1230f6dfb4c3SHadar Hen Zion list_for_each_entry(e, &nhe->encap_list, encap_list) { 123179baaec7SEli Britstein struct encap_flow_item *efi; 1232f6dfb4c3SHadar Hen Zion if (!(e->flags & MLX5_ENCAP_ENTRY_VALID)) 1233f6dfb4c3SHadar Hen Zion continue; 123479baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 123579baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, 123679baaec7SEli Britstein encaps[efi->index]); 1237f6dfb4c3SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 1238b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 1239f6dfb4c3SHadar Hen Zion mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 1240f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 1241f6dfb4c3SHadar Hen Zion neigh_used = true; 1242f6dfb4c3SHadar Hen Zion break; 1243f6dfb4c3SHadar Hen Zion } 1244f6dfb4c3SHadar Hen Zion } 1245f6dfb4c3SHadar Hen Zion } 1246e36d4810SRoi Dayan if (neigh_used) 1247e36d4810SRoi Dayan break; 1248f6dfb4c3SHadar Hen Zion } 1249f6dfb4c3SHadar Hen Zion 1250f6dfb4c3SHadar Hen Zion if (neigh_used) { 1251f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 1252f6dfb4c3SHadar Hen Zion 1253f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 1254f6dfb4c3SHadar Hen Zion * dst ip pair 1255f6dfb4c3SHadar Hen Zion */ 1256f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 1257c7f7ba8dSRoi Dayan if (!n) 1258f6dfb4c3SHadar Hen Zion return; 1259f6dfb4c3SHadar Hen Zion 1260f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 1261f6dfb4c3SHadar Hen Zion neigh_release(n); 1262f6dfb4c3SHadar Hen Zion } 1263f6dfb4c3SHadar Hen Zion } 1264f6dfb4c3SHadar Hen Zion 1265d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 12668c4dc42bSEli Britstein struct mlx5e_tc_flow *flow, int out_index) 1267d85cdccbSOr Gerlitz { 12688c4dc42bSEli Britstein struct list_head *next = flow->encaps[out_index].list.next; 12695067b602SRoi Dayan 12708c4dc42bSEli Britstein list_del(&flow->encaps[out_index].list); 12715067b602SRoi Dayan if (list_empty(next)) { 1272c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 12735067b602SRoi Dayan 1274c1ae1152SOr Gerlitz e = list_entry(next, struct mlx5e_encap_entry, flows); 1275232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1276232c0013SHadar Hen Zion 1277232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 127860786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1279232c0013SHadar Hen Zion 1280cdc5a7f3SOr Gerlitz hash_del_rcu(&e->encap_hlist); 1281232c0013SHadar Hen Zion kfree(e->encap_header); 12825067b602SRoi Dayan kfree(e); 12835067b602SRoi Dayan } 12845067b602SRoi Dayan } 12855067b602SRoi Dayan 128604de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 128704de7ddaSRoi Dayan { 128804de7ddaSRoi Dayan struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch; 128904de7ddaSRoi Dayan 129004de7ddaSRoi Dayan if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) || 129104de7ddaSRoi Dayan !(flow->flags & MLX5E_TC_FLOW_DUP)) 129204de7ddaSRoi Dayan return; 129304de7ddaSRoi Dayan 129404de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 129504de7ddaSRoi Dayan list_del(&flow->peer); 129604de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 129704de7ddaSRoi Dayan 129804de7ddaSRoi Dayan flow->flags &= ~MLX5E_TC_FLOW_DUP; 129904de7ddaSRoi Dayan 130004de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow); 130104de7ddaSRoi Dayan kvfree(flow->peer_flow); 130204de7ddaSRoi Dayan flow->peer_flow = NULL; 130304de7ddaSRoi Dayan } 130404de7ddaSRoi Dayan 130504de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 130604de7ddaSRoi Dayan { 130704de7ddaSRoi Dayan struct mlx5_core_dev *dev = flow->priv->mdev; 130804de7ddaSRoi Dayan struct mlx5_devcom *devcom = dev->priv.devcom; 130904de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 131004de7ddaSRoi Dayan 131104de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 131204de7ddaSRoi Dayan if (!peer_esw) 131304de7ddaSRoi Dayan return; 131404de7ddaSRoi Dayan 131504de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 131604de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 131704de7ddaSRoi Dayan } 131804de7ddaSRoi Dayan 1319e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1320961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1321e8f887acSAmir Vadai { 132204de7ddaSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 132304de7ddaSRoi Dayan mlx5e_tc_del_fdb_peer_flow(flow); 1324d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 132504de7ddaSRoi Dayan } else { 1326d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1327e8f887acSAmir Vadai } 132804de7ddaSRoi Dayan } 1329e8f887acSAmir Vadai 1330bbd00f7eSHadar Hen Zion 1331bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1332bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 133354c177caSOz Shlomo struct tc_cls_flower_offload *f, 13346363651dSOr Gerlitz struct net_device *filter_dev, u8 *match_level) 1335bbd00f7eSHadar Hen Zion { 1336e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1337bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1338bbd00f7eSHadar Hen Zion outer_headers); 1339bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1340bbd00f7eSHadar Hen Zion outer_headers); 13418f256622SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 13428f256622SPablo Neira Ayuso int err; 1343bbd00f7eSHadar Hen Zion 1344101f4de9SOz Shlomo err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f, 13456363651dSOr Gerlitz headers_c, headers_v, match_level); 134654c177caSOz Shlomo if (err) { 134754c177caSOz Shlomo NL_SET_ERR_MSG_MOD(extack, 134854c177caSOz Shlomo "failed to parse tunnel attributes"); 1349101f4de9SOz Shlomo return err; 1350bbd00f7eSHadar Hen Zion } 1351bbd00f7eSHadar Hen Zion 1352d1bda7eeSTonghao Zhang if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS)) { 13538f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 13548f256622SPablo Neira Ayuso 13558f256622SPablo Neira Ayuso flow_rule_match_enc_ipv4_addrs(rule, &match); 1356bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1357bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 13588f256622SPablo Neira Ayuso ntohl(match.mask->src)); 1359bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1360bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 13618f256622SPablo Neira Ayuso ntohl(match.key->src)); 1362bbd00f7eSHadar Hen Zion 1363bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1364bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 13658f256622SPablo Neira Ayuso ntohl(match.mask->dst)); 1366bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1367bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 13688f256622SPablo Neira Ayuso ntohl(match.key->dst)); 1369bbd00f7eSHadar Hen Zion 1370bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 1371bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP); 1372d1bda7eeSTonghao Zhang } else if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS)) { 13738f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 137419f44401SOr Gerlitz 13758f256622SPablo Neira Ayuso flow_rule_match_enc_ipv6_addrs(rule, &match); 137619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 137719f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 13788f256622SPablo Neira Ayuso &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 137919f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 138019f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 13818f256622SPablo Neira Ayuso &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 138219f44401SOr Gerlitz 138319f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 138419f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 13858f256622SPablo Neira Ayuso &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 138619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 138719f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 13888f256622SPablo Neira Ayuso &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 138919f44401SOr Gerlitz 139019f44401SOr Gerlitz MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 139119f44401SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6); 13922e72eb43SOr Gerlitz } 1393bbd00f7eSHadar Hen Zion 13948f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) { 13958f256622SPablo Neira Ayuso struct flow_match_ip match; 1396bcef735cSOr Gerlitz 13978f256622SPablo Neira Ayuso flow_rule_match_enc_ip(rule, &match); 13988f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 13998f256622SPablo Neira Ayuso match.mask->tos & 0x3); 14008f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 14018f256622SPablo Neira Ayuso match.key->tos & 0x3); 1402bcef735cSOr Gerlitz 14038f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 14048f256622SPablo Neira Ayuso match.mask->tos >> 2); 14058f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 14068f256622SPablo Neira Ayuso match.key->tos >> 2); 1407bcef735cSOr Gerlitz 14088f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 14098f256622SPablo Neira Ayuso match.mask->ttl); 14108f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 14118f256622SPablo Neira Ayuso match.key->ttl); 1412e98bedf5SEli Britstein 14138f256622SPablo Neira Ayuso if (match.mask->ttl && 1414e98bedf5SEli Britstein !MLX5_CAP_ESW_FLOWTABLE_FDB 1415e98bedf5SEli Britstein (priv->mdev, 1416e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1417e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1418e98bedf5SEli Britstein "Matching on TTL is not supported"); 1419e98bedf5SEli Britstein return -EOPNOTSUPP; 1420e98bedf5SEli Britstein } 1421e98bedf5SEli Britstein 1422bcef735cSOr Gerlitz } 1423bcef735cSOr Gerlitz 1424bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1425bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1426bbd00f7eSHadar Hen Zion */ 1427bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1428bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1429bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1430bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1431bbd00f7eSHadar Hen Zion 1432bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1433bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1434bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1435bbd00f7eSHadar Hen Zion 1436bbd00f7eSHadar Hen Zion return 0; 1437bbd00f7eSHadar Hen Zion } 1438bbd00f7eSHadar Hen Zion 14398377629eSEli Britstein static void *get_match_headers_criteria(u32 flags, 14408377629eSEli Britstein struct mlx5_flow_spec *spec) 14418377629eSEli Britstein { 14428377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 14438377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 14448377629eSEli Britstein inner_headers) : 14458377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 14468377629eSEli Britstein outer_headers); 14478377629eSEli Britstein } 14488377629eSEli Britstein 14498377629eSEli Britstein static void *get_match_headers_value(u32 flags, 14508377629eSEli Britstein struct mlx5_flow_spec *spec) 14518377629eSEli Britstein { 14528377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 14538377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 14548377629eSEli Britstein inner_headers) : 14558377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 14568377629eSEli Britstein outer_headers); 14578377629eSEli Britstein } 14588377629eSEli Britstein 1459de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1460de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1461de0af0bfSRoi Dayan struct tc_cls_flower_offload *f, 146254c177caSOz Shlomo struct net_device *filter_dev, 14636363651dSOr Gerlitz u8 *match_level, u8 *tunnel_match_level) 1464e3a2b7edSAmir Vadai { 1465e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1466c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1467c5bb1730SMaor Gottlieb outer_headers); 1468c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1469c5bb1730SMaor Gottlieb outer_headers); 1470699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1471699e96ddSJianbo Liu misc_parameters); 1472699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1473699e96ddSJianbo Liu misc_parameters); 14748f256622SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 14758f256622SPablo Neira Ayuso struct flow_dissector *dissector = rule->match.dissector; 1476e3a2b7edSAmir Vadai u16 addr_type = 0; 1477e3a2b7edSAmir Vadai u8 ip_proto = 0; 1478e3a2b7edSAmir Vadai 1479d708f902SOr Gerlitz *match_level = MLX5_MATCH_NONE; 1480de0af0bfSRoi Dayan 14818f256622SPablo Neira Ayuso if (dissector->used_keys & 1482e3a2b7edSAmir Vadai ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1483e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1484e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1485095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1486699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1487e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1488e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1489bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1490bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1491bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1492bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1493bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1494e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1495fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1496bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP) | 1497bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_IP))) { 1498e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "Unsupported key"); 1499e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 15008f256622SPablo Neira Ayuso dissector->used_keys); 1501e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1502e3a2b7edSAmir Vadai } 1503e3a2b7edSAmir Vadai 1504d1bda7eeSTonghao Zhang if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) || 1505d1bda7eeSTonghao Zhang flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) || 15068f256622SPablo Neira Ayuso flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) || 1507d1bda7eeSTonghao Zhang flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) { 15086363651dSOr Gerlitz if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level)) 1509bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1510bbd00f7eSHadar Hen Zion 1511bbd00f7eSHadar Hen Zion /* In decap flow, header pointers should point to the inner 1512bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1513bbd00f7eSHadar Hen Zion */ 15148377629eSEli Britstein headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP, 15158377629eSEli Britstein spec); 15168377629eSEli Britstein headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP, 15178377629eSEli Britstein spec); 1518bbd00f7eSHadar Hen Zion } 1519bbd00f7eSHadar Hen Zion 15208f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 15218f256622SPablo Neira Ayuso struct flow_match_basic match; 1522e3a2b7edSAmir Vadai 15238f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 15248f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 15258f256622SPablo Neira Ayuso ntohs(match.mask->n_proto)); 15268f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 15278f256622SPablo Neira Ayuso ntohs(match.key->n_proto)); 15288f256622SPablo Neira Ayuso 15298f256622SPablo Neira Ayuso if (match.mask->n_proto) 1530d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1531e3a2b7edSAmir Vadai } 153235a605dbSEli Britstein if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) || 153335a605dbSEli Britstein is_vlan_dev(filter_dev)) { 153435a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_mask; 153535a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_key; 15368f256622SPablo Neira Ayuso struct flow_match_vlan match; 15378f256622SPablo Neira Ayuso 153835a605dbSEli Britstein if (is_vlan_dev(filter_dev)) { 153935a605dbSEli Britstein match.key = &filter_dev_key; 154035a605dbSEli Britstein match.key->vlan_id = vlan_dev_vlan_id(filter_dev); 154135a605dbSEli Britstein match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev); 154235a605dbSEli Britstein match.key->vlan_priority = 0; 154335a605dbSEli Britstein match.mask = &filter_dev_mask; 154435a605dbSEli Britstein memset(match.mask, 0xff, sizeof(*match.mask)); 154535a605dbSEli Britstein match.mask->vlan_priority = 0; 154635a605dbSEli Britstein } else { 15478f256622SPablo Neira Ayuso flow_rule_match_vlan(rule, &match); 154835a605dbSEli Britstein } 15498f256622SPablo Neira Ayuso if (match.mask->vlan_id || 15508f256622SPablo Neira Ayuso match.mask->vlan_priority || 15518f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 15528f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1553699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1554699e96ddSJianbo Liu svlan_tag, 1); 1555699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1556699e96ddSJianbo Liu svlan_tag, 1); 1557699e96ddSJianbo Liu } else { 1558699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1559699e96ddSJianbo Liu cvlan_tag, 1); 1560699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1561699e96ddSJianbo Liu cvlan_tag, 1); 1562699e96ddSJianbo Liu } 1563095b6cfdSOr Gerlitz 15648f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, 15658f256622SPablo Neira Ayuso match.mask->vlan_id); 15668f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, 15678f256622SPablo Neira Ayuso match.key->vlan_id); 1568358d79a4SOr Gerlitz 15698f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, 15708f256622SPablo Neira Ayuso match.mask->vlan_priority); 15718f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, 15728f256622SPablo Neira Ayuso match.key->vlan_priority); 157354782900SOr Gerlitz 1574d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1575095b6cfdSOr Gerlitz } 1576d3a80bb5SOr Gerlitz } else if (*match_level != MLX5_MATCH_NONE) { 1577cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1); 1578cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 1579d3a80bb5SOr Gerlitz *match_level = MLX5_MATCH_L2; 1580095b6cfdSOr Gerlitz } 1581095b6cfdSOr Gerlitz 15828f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) { 15838f256622SPablo Neira Ayuso struct flow_match_vlan match; 15848f256622SPablo Neira Ayuso 158512d5cbf8SJianbo Liu flow_rule_match_cvlan(rule, &match); 15868f256622SPablo Neira Ayuso if (match.mask->vlan_id || 15878f256622SPablo Neira Ayuso match.mask->vlan_priority || 15888f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 15898f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1590699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1591699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1592699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1593699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1594699e96ddSJianbo Liu } else { 1595699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1596699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1597699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1598699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1599699e96ddSJianbo Liu } 1600699e96ddSJianbo Liu 1601699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 16028f256622SPablo Neira Ayuso match.mask->vlan_id); 1603699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 16048f256622SPablo Neira Ayuso match.key->vlan_id); 1605699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 16068f256622SPablo Neira Ayuso match.mask->vlan_priority); 1607699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 16088f256622SPablo Neira Ayuso match.key->vlan_priority); 1609699e96ddSJianbo Liu 1610699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1611699e96ddSJianbo Liu } 1612699e96ddSJianbo Liu } 1613699e96ddSJianbo Liu 16148f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 16158f256622SPablo Neira Ayuso struct flow_match_eth_addrs match; 161654782900SOr Gerlitz 16178f256622SPablo Neira Ayuso flow_rule_match_eth_addrs(rule, &match); 1618d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1619d3a80bb5SOr Gerlitz dmac_47_16), 16208f256622SPablo Neira Ayuso match.mask->dst); 1621d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1622d3a80bb5SOr Gerlitz dmac_47_16), 16238f256622SPablo Neira Ayuso match.key->dst); 1624d3a80bb5SOr Gerlitz 1625d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1626d3a80bb5SOr Gerlitz smac_47_16), 16278f256622SPablo Neira Ayuso match.mask->src); 1628d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1629d3a80bb5SOr Gerlitz smac_47_16), 16308f256622SPablo Neira Ayuso match.key->src); 1631d3a80bb5SOr Gerlitz 16328f256622SPablo Neira Ayuso if (!is_zero_ether_addr(match.mask->src) || 16338f256622SPablo Neira Ayuso !is_zero_ether_addr(match.mask->dst)) 1634d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 163554782900SOr Gerlitz } 163654782900SOr Gerlitz 16378f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) { 16388f256622SPablo Neira Ayuso struct flow_match_control match; 163954782900SOr Gerlitz 16408f256622SPablo Neira Ayuso flow_rule_match_control(rule, &match); 16418f256622SPablo Neira Ayuso addr_type = match.key->addr_type; 164254782900SOr Gerlitz 164354782900SOr Gerlitz /* the HW doesn't support frag first/later */ 16448f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_FIRST_FRAG) 164554782900SOr Gerlitz return -EOPNOTSUPP; 164654782900SOr Gerlitz 16478f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) { 164854782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 164954782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 16508f256622SPablo Neira Ayuso match.key->flags & FLOW_DIS_IS_FRAGMENT); 165154782900SOr Gerlitz 165254782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 16538f256622SPablo Neira Ayuso if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT)) 165483621b7dSOr Gerlitz *match_level = MLX5_MATCH_L2; 165554782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 165654782900SOr Gerlitz else 165783621b7dSOr Gerlitz *match_level = MLX5_MATCH_L3; 165854782900SOr Gerlitz } 165954782900SOr Gerlitz } 166054782900SOr Gerlitz 16618f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 16628f256622SPablo Neira Ayuso struct flow_match_basic match; 16638f256622SPablo Neira Ayuso 16648f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 16658f256622SPablo Neira Ayuso ip_proto = match.key->ip_proto; 166654782900SOr Gerlitz 166754782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 16688f256622SPablo Neira Ayuso match.mask->ip_proto); 166954782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 16708f256622SPablo Neira Ayuso match.key->ip_proto); 167154782900SOr Gerlitz 16728f256622SPablo Neira Ayuso if (match.mask->ip_proto) 1673d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 167454782900SOr Gerlitz } 167554782900SOr Gerlitz 1676e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 16778f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 1678e3a2b7edSAmir Vadai 16798f256622SPablo Neira Ayuso flow_rule_match_ipv4_addrs(rule, &match); 1680e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1681e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 16828f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 1683e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1684e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 16858f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 1686e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1687e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 16888f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 1689e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1690e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 16918f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 1692de0af0bfSRoi Dayan 16938f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 1694d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1695e3a2b7edSAmir Vadai } 1696e3a2b7edSAmir Vadai 1697e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 16988f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 1699e3a2b7edSAmir Vadai 17008f256622SPablo Neira Ayuso flow_rule_match_ipv6_addrs(rule, &match); 1701e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1702e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 17038f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 1704e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1705e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 17068f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 1707e3a2b7edSAmir Vadai 1708e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1709e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 17108f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 1711e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1712e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 17138f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 1714de0af0bfSRoi Dayan 17158f256622SPablo Neira Ayuso if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY || 17168f256622SPablo Neira Ayuso ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY) 1717d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1718e3a2b7edSAmir Vadai } 1719e3a2b7edSAmir Vadai 17208f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) { 17218f256622SPablo Neira Ayuso struct flow_match_ip match; 17221f97a526SOr Gerlitz 17238f256622SPablo Neira Ayuso flow_rule_match_ip(rule, &match); 17248f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 17258f256622SPablo Neira Ayuso match.mask->tos & 0x3); 17268f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 17278f256622SPablo Neira Ayuso match.key->tos & 0x3); 17281f97a526SOr Gerlitz 17298f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 17308f256622SPablo Neira Ayuso match.mask->tos >> 2); 17318f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 17328f256622SPablo Neira Ayuso match.key->tos >> 2); 17331f97a526SOr Gerlitz 17348f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 17358f256622SPablo Neira Ayuso match.mask->ttl); 17368f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 17378f256622SPablo Neira Ayuso match.key->ttl); 17381f97a526SOr Gerlitz 17398f256622SPablo Neira Ayuso if (match.mask->ttl && 1740a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 1741e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1742e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1743e98bedf5SEli Britstein "Matching on TTL is not supported"); 17441f97a526SOr Gerlitz return -EOPNOTSUPP; 1745e98bedf5SEli Britstein } 1746a8ade55fSOr Gerlitz 17478f256622SPablo Neira Ayuso if (match.mask->tos || match.mask->ttl) 1748d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 17491f97a526SOr Gerlitz } 17501f97a526SOr Gerlitz 175154782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 175254782900SOr Gerlitz 17538f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) { 17548f256622SPablo Neira Ayuso struct flow_match_ports match; 17558f256622SPablo Neira Ayuso 17568f256622SPablo Neira Ayuso flow_rule_match_ports(rule, &match); 1757e3a2b7edSAmir Vadai switch (ip_proto) { 1758e3a2b7edSAmir Vadai case IPPROTO_TCP: 1759e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17608f256622SPablo Neira Ayuso tcp_sport, ntohs(match.mask->src)); 1761e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17628f256622SPablo Neira Ayuso tcp_sport, ntohs(match.key->src)); 1763e3a2b7edSAmir Vadai 1764e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17658f256622SPablo Neira Ayuso tcp_dport, ntohs(match.mask->dst)); 1766e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17678f256622SPablo Neira Ayuso tcp_dport, ntohs(match.key->dst)); 1768e3a2b7edSAmir Vadai break; 1769e3a2b7edSAmir Vadai 1770e3a2b7edSAmir Vadai case IPPROTO_UDP: 1771e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17728f256622SPablo Neira Ayuso udp_sport, ntohs(match.mask->src)); 1773e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17748f256622SPablo Neira Ayuso udp_sport, ntohs(match.key->src)); 1775e3a2b7edSAmir Vadai 1776e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17778f256622SPablo Neira Ayuso udp_dport, ntohs(match.mask->dst)); 1778e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17798f256622SPablo Neira Ayuso udp_dport, ntohs(match.key->dst)); 1780e3a2b7edSAmir Vadai break; 1781e3a2b7edSAmir Vadai default: 1782e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1783e98bedf5SEli Britstein "Only UDP and TCP transports are supported for L4 matching"); 1784e3a2b7edSAmir Vadai netdev_err(priv->netdev, 1785e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 1786e3a2b7edSAmir Vadai return -EINVAL; 1787e3a2b7edSAmir Vadai } 1788de0af0bfSRoi Dayan 17898f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 1790d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1791e3a2b7edSAmir Vadai } 1792e3a2b7edSAmir Vadai 17938f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) { 17948f256622SPablo Neira Ayuso struct flow_match_tcp match; 1795e77834ecSOr Gerlitz 17968f256622SPablo Neira Ayuso flow_rule_match_tcp(rule, &match); 1797e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 17988f256622SPablo Neira Ayuso ntohs(match.mask->flags)); 1799e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 18008f256622SPablo Neira Ayuso ntohs(match.key->flags)); 1801e77834ecSOr Gerlitz 18028f256622SPablo Neira Ayuso if (match.mask->flags) 1803d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1804e77834ecSOr Gerlitz } 1805e77834ecSOr Gerlitz 1806e3a2b7edSAmir Vadai return 0; 1807e3a2b7edSAmir Vadai } 1808e3a2b7edSAmir Vadai 1809de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 181065ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 1811de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 181254c177caSOz Shlomo struct tc_cls_flower_offload *f, 181354c177caSOz Shlomo struct net_device *filter_dev) 1814de0af0bfSRoi Dayan { 1815e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1816de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 1817de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 18181d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 18196363651dSOr Gerlitz u8 match_level, tunnel_match_level = MLX5_MATCH_NONE; 18201d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 1821de0af0bfSRoi Dayan int err; 1822de0af0bfSRoi Dayan 18236363651dSOr Gerlitz err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level); 1824de0af0bfSRoi Dayan 18251d447a39SSaeed Mahameed if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) { 18261d447a39SSaeed Mahameed rep = rpriv->rep; 1827b05af6aaSBodong Wang if (rep->vport != MLX5_VPORT_UPLINK && 18281d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 1829d708f902SOr Gerlitz esw->offloads.inline_mode < match_level)) { 1830e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1831e98bedf5SEli Britstein "Flow is not offloaded due to min inline setting"); 1832de0af0bfSRoi Dayan netdev_warn(priv->netdev, 1833de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 1834d708f902SOr Gerlitz match_level, esw->offloads.inline_mode); 1835de0af0bfSRoi Dayan return -EOPNOTSUPP; 1836de0af0bfSRoi Dayan } 1837de0af0bfSRoi Dayan } 1838de0af0bfSRoi Dayan 18396363651dSOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 184038aa51c1SOr Gerlitz flow->esw_attr->match_level = match_level; 18416363651dSOr Gerlitz flow->esw_attr->tunnel_match_level = tunnel_match_level; 18426363651dSOr Gerlitz } else { 184338aa51c1SOr Gerlitz flow->nic_attr->match_level = match_level; 18446363651dSOr Gerlitz } 184538aa51c1SOr Gerlitz 1846de0af0bfSRoi Dayan return err; 1847de0af0bfSRoi Dayan } 1848de0af0bfSRoi Dayan 1849d79b6df6SOr Gerlitz struct pedit_headers { 1850d79b6df6SOr Gerlitz struct ethhdr eth; 18510eb69bb9SEli Britstein struct vlan_hdr vlan; 1852d79b6df6SOr Gerlitz struct iphdr ip4; 1853d79b6df6SOr Gerlitz struct ipv6hdr ip6; 1854d79b6df6SOr Gerlitz struct tcphdr tcp; 1855d79b6df6SOr Gerlitz struct udphdr udp; 1856d79b6df6SOr Gerlitz }; 1857d79b6df6SOr Gerlitz 1858c500c86bSPablo Neira Ayuso struct pedit_headers_action { 1859c500c86bSPablo Neira Ayuso struct pedit_headers vals; 1860c500c86bSPablo Neira Ayuso struct pedit_headers masks; 1861c500c86bSPablo Neira Ayuso u32 pedits; 1862c500c86bSPablo Neira Ayuso }; 1863c500c86bSPablo Neira Ayuso 1864d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 186573867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 186673867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 186773867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 186873867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 186973867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 1870d79b6df6SOr Gerlitz }; 1871d79b6df6SOr Gerlitz 1872d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 1873d79b6df6SOr Gerlitz 1874d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 1875c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs) 1876d79b6df6SOr Gerlitz { 1877d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 1878d79b6df6SOr Gerlitz 1879c500c86bSPablo Neira Ayuso curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset); 1880c500c86bSPablo Neira Ayuso curr_pval = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset); 1881d79b6df6SOr Gerlitz 1882d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 1883d79b6df6SOr Gerlitz goto out_err; 1884d79b6df6SOr Gerlitz 1885d79b6df6SOr Gerlitz *curr_pmask |= mask; 1886d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 1887d79b6df6SOr Gerlitz 1888d79b6df6SOr Gerlitz return 0; 1889d79b6df6SOr Gerlitz 1890d79b6df6SOr Gerlitz out_err: 1891d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1892d79b6df6SOr Gerlitz } 1893d79b6df6SOr Gerlitz 1894d79b6df6SOr Gerlitz struct mlx5_fields { 1895d79b6df6SOr Gerlitz u8 field; 1896d79b6df6SOr Gerlitz u8 size; 1897d79b6df6SOr Gerlitz u32 offset; 189827c11b6bSEli Britstein u32 match_offset; 1899d79b6df6SOr Gerlitz }; 1900d79b6df6SOr Gerlitz 190127c11b6bSEli Britstein #define OFFLOAD(fw_field, size, field, off, match_field) \ 190227c11b6bSEli Britstein {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, \ 190327c11b6bSEli Britstein offsetof(struct pedit_headers, field) + (off), \ 190427c11b6bSEli Britstein MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)} 190527c11b6bSEli Britstein 19062ef86872SEli Britstein /* masked values are the same and there are no rewrites that do not have a 19072ef86872SEli Britstein * match. 19082ef86872SEli Britstein */ 19092ef86872SEli Britstein #define SAME_VAL_MASK(type, valp, maskp, matchvalp, matchmaskp) ({ \ 19102ef86872SEli Britstein type matchmaskx = *(type *)(matchmaskp); \ 19112ef86872SEli Britstein type matchvalx = *(type *)(matchvalp); \ 19122ef86872SEli Britstein type maskx = *(type *)(maskp); \ 19132ef86872SEli Britstein type valx = *(type *)(valp); \ 19142ef86872SEli Britstein \ 19152ef86872SEli Britstein (valx & maskx) == (matchvalx & matchmaskx) && !(maskx & (maskx ^ \ 19162ef86872SEli Britstein matchmaskx)); \ 19172ef86872SEli Britstein }) 19182ef86872SEli Britstein 191927c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp, 192027c11b6bSEli Britstein void *matchmaskp, int size) 192127c11b6bSEli Britstein { 192227c11b6bSEli Britstein bool same = false; 192327c11b6bSEli Britstein 192427c11b6bSEli Britstein switch (size) { 192527c11b6bSEli Britstein case sizeof(u8): 19262ef86872SEli Britstein same = SAME_VAL_MASK(u8, valp, maskp, matchvalp, matchmaskp); 192727c11b6bSEli Britstein break; 192827c11b6bSEli Britstein case sizeof(u16): 19292ef86872SEli Britstein same = SAME_VAL_MASK(u16, valp, maskp, matchvalp, matchmaskp); 193027c11b6bSEli Britstein break; 193127c11b6bSEli Britstein case sizeof(u32): 19322ef86872SEli Britstein same = SAME_VAL_MASK(u32, valp, maskp, matchvalp, matchmaskp); 193327c11b6bSEli Britstein break; 193427c11b6bSEli Britstein } 193527c11b6bSEli Britstein 193627c11b6bSEli Britstein return same; 193727c11b6bSEli Britstein } 1938a8e4f0c4SOr Gerlitz 1939d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 194027c11b6bSEli Britstein OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0, dmac_47_16), 194127c11b6bSEli Britstein OFFLOAD(DMAC_15_0, 2, eth.h_dest[4], 0, dmac_15_0), 194227c11b6bSEli Britstein OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0, smac_47_16), 194327c11b6bSEli Britstein OFFLOAD(SMAC_15_0, 2, eth.h_source[4], 0, smac_15_0), 194427c11b6bSEli Britstein OFFLOAD(ETHERTYPE, 2, eth.h_proto, 0, ethertype), 194527c11b6bSEli Britstein OFFLOAD(FIRST_VID, 2, vlan.h_vlan_TCI, 0, first_vid), 1946d79b6df6SOr Gerlitz 194727c11b6bSEli Britstein OFFLOAD(IP_TTL, 1, ip4.ttl, 0, ttl_hoplimit), 194827c11b6bSEli Britstein OFFLOAD(SIPV4, 4, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4), 194927c11b6bSEli Britstein OFFLOAD(DIPV4, 4, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1950d79b6df6SOr Gerlitz 195127c11b6bSEli Britstein OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0, 195227c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[0]), 195327c11b6bSEli Britstein OFFLOAD(SIPV6_95_64, 4, ip6.saddr.s6_addr32[1], 0, 195427c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[4]), 195527c11b6bSEli Britstein OFFLOAD(SIPV6_63_32, 4, ip6.saddr.s6_addr32[2], 0, 195627c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[8]), 195727c11b6bSEli Britstein OFFLOAD(SIPV6_31_0, 4, ip6.saddr.s6_addr32[3], 0, 195827c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[12]), 195927c11b6bSEli Britstein OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0, 196027c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]), 196127c11b6bSEli Britstein OFFLOAD(DIPV6_95_64, 4, ip6.daddr.s6_addr32[1], 0, 196227c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]), 196327c11b6bSEli Britstein OFFLOAD(DIPV6_63_32, 4, ip6.daddr.s6_addr32[2], 0, 196427c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]), 196527c11b6bSEli Britstein OFFLOAD(DIPV6_31_0, 4, ip6.daddr.s6_addr32[3], 0, 196627c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]), 196727c11b6bSEli Britstein OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0, ttl_hoplimit), 1968d79b6df6SOr Gerlitz 196927c11b6bSEli Britstein OFFLOAD(TCP_SPORT, 2, tcp.source, 0, tcp_sport), 197027c11b6bSEli Britstein OFFLOAD(TCP_DPORT, 2, tcp.dest, 0, tcp_dport), 197127c11b6bSEli Britstein OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5, tcp_flags), 1972d79b6df6SOr Gerlitz 197327c11b6bSEli Britstein OFFLOAD(UDP_SPORT, 2, udp.source, 0, udp_sport), 197427c11b6bSEli Britstein OFFLOAD(UDP_DPORT, 2, udp.dest, 0, udp_dport), 1975d79b6df6SOr Gerlitz }; 1976d79b6df6SOr Gerlitz 1977218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at 1978218d05ceSTonghao Zhang * max from the SW pedit action. On success, attr->num_mod_hdr_actions 1979218d05ceSTonghao Zhang * says how many HW actions were actually parsed. 1980d79b6df6SOr Gerlitz */ 1981c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs, 1982e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 198327c11b6bSEli Britstein u32 *action_flags, 1984e98bedf5SEli Britstein struct netlink_ext_ack *extack) 1985d79b6df6SOr Gerlitz { 1986d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 198727c11b6bSEli Britstein void *headers_c = get_match_headers_criteria(*action_flags, 198827c11b6bSEli Britstein &parse_attr->spec); 198927c11b6bSEli Britstein void *headers_v = get_match_headers_value(*action_flags, 199027c11b6bSEli Britstein &parse_attr->spec); 19912b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 1992d79b6df6SOr Gerlitz void *s_masks_p, *a_masks_p, *vals_p; 1993d79b6df6SOr Gerlitz struct mlx5_fields *f; 1994d79b6df6SOr Gerlitz u8 cmd, field_bsize; 1995e3ca4e05SOr Gerlitz u32 s_mask, a_mask; 1996d79b6df6SOr Gerlitz unsigned long mask; 19972b64bebaSOr Gerlitz __be32 mask_be32; 19982b64bebaSOr Gerlitz __be16 mask_be16; 1999d79b6df6SOr Gerlitz void *action; 2000d79b6df6SOr Gerlitz 200173867881SPablo Neira Ayuso set_masks = &hdrs[0].masks; 200273867881SPablo Neira Ayuso add_masks = &hdrs[1].masks; 200373867881SPablo Neira Ayuso set_vals = &hdrs[0].vals; 200473867881SPablo Neira Ayuso add_vals = &hdrs[1].vals; 2005d79b6df6SOr Gerlitz 2006d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2007218d05ceSTonghao Zhang action = parse_attr->mod_hdr_actions + 2008218d05ceSTonghao Zhang parse_attr->num_mod_hdr_actions * action_size; 2009218d05ceSTonghao Zhang 2010218d05ceSTonghao Zhang max_actions = parse_attr->max_mod_hdr_actions; 2011218d05ceSTonghao Zhang nactions = parse_attr->num_mod_hdr_actions; 2012d79b6df6SOr Gerlitz 2013d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 201427c11b6bSEli Britstein bool skip; 201527c11b6bSEli Britstein 2016d79b6df6SOr Gerlitz f = &fields[i]; 2017d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 2018e3ca4e05SOr Gerlitz s_mask = 0; 2019e3ca4e05SOr Gerlitz a_mask = 0; 2020d79b6df6SOr Gerlitz 2021d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 2022d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 2023d79b6df6SOr Gerlitz 2024d79b6df6SOr Gerlitz memcpy(&s_mask, s_masks_p, f->size); 2025d79b6df6SOr Gerlitz memcpy(&a_mask, a_masks_p, f->size); 2026d79b6df6SOr Gerlitz 2027d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 2028d79b6df6SOr Gerlitz continue; 2029d79b6df6SOr Gerlitz 2030d79b6df6SOr Gerlitz if (s_mask && a_mask) { 2031e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2032e98bedf5SEli Britstein "can't set and add to the same HW field"); 2033d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 2034d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2035d79b6df6SOr Gerlitz } 2036d79b6df6SOr Gerlitz 2037d79b6df6SOr Gerlitz if (nactions == max_actions) { 2038e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2039e98bedf5SEli Britstein "too many pedit actions, can't offload"); 2040d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 2041d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2042d79b6df6SOr Gerlitz } 2043d79b6df6SOr Gerlitz 204427c11b6bSEli Britstein skip = false; 2045d79b6df6SOr Gerlitz if (s_mask) { 204627c11b6bSEli Britstein void *match_mask = headers_c + f->match_offset; 204727c11b6bSEli Britstein void *match_val = headers_v + f->match_offset; 204827c11b6bSEli Britstein 2049d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 2050d79b6df6SOr Gerlitz mask = s_mask; 2051d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 205227c11b6bSEli Britstein /* don't rewrite if we have a match on the same value */ 205327c11b6bSEli Britstein if (cmp_val_mask(vals_p, s_masks_p, match_val, 205427c11b6bSEli Britstein match_mask, f->size)) 205527c11b6bSEli Britstein skip = true; 2056d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 2057d79b6df6SOr Gerlitz memset(s_masks_p, 0, f->size); 2058d79b6df6SOr Gerlitz } else { 205927c11b6bSEli Britstein u32 zero = 0; 206027c11b6bSEli Britstein 2061d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 2062d79b6df6SOr Gerlitz mask = a_mask; 2063d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 206427c11b6bSEli Britstein /* add 0 is no change */ 206527c11b6bSEli Britstein if (!memcmp(vals_p, &zero, f->size)) 206627c11b6bSEli Britstein skip = true; 2067d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 2068d79b6df6SOr Gerlitz memset(a_masks_p, 0, f->size); 2069d79b6df6SOr Gerlitz } 207027c11b6bSEli Britstein if (skip) 207127c11b6bSEli Britstein continue; 2072d79b6df6SOr Gerlitz 2073d79b6df6SOr Gerlitz field_bsize = f->size * BITS_PER_BYTE; 2074e3ca4e05SOr Gerlitz 20752b64bebaSOr Gerlitz if (field_bsize == 32) { 20762b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 20772b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 20782b64bebaSOr Gerlitz } else if (field_bsize == 16) { 20792b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 20802b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 20812b64bebaSOr Gerlitz } 20822b64bebaSOr Gerlitz 2083d79b6df6SOr Gerlitz first = find_first_bit(&mask, field_bsize); 20842b64bebaSOr Gerlitz next_z = find_next_zero_bit(&mask, field_bsize, first); 2085d79b6df6SOr Gerlitz last = find_last_bit(&mask, field_bsize); 20862b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 2087e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2088e98bedf5SEli Britstein "rewrite of few sub-fields isn't supported"); 20892b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 2090d79b6df6SOr Gerlitz mask); 2091d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2092d79b6df6SOr Gerlitz } 2093d79b6df6SOr Gerlitz 2094d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 2095d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 2096d79b6df6SOr Gerlitz 2097d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 20982b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, offset, first); 2099d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 21002b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 2101d79b6df6SOr Gerlitz } 2102d79b6df6SOr Gerlitz 2103d79b6df6SOr Gerlitz if (field_bsize == 32) 21042b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 2105d79b6df6SOr Gerlitz else if (field_bsize == 16) 21062b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 2107d79b6df6SOr Gerlitz else if (field_bsize == 8) 21082b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 2109d79b6df6SOr Gerlitz 2110d79b6df6SOr Gerlitz action += action_size; 2111d79b6df6SOr Gerlitz nactions++; 2112d79b6df6SOr Gerlitz } 2113d79b6df6SOr Gerlitz 2114d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 2115d79b6df6SOr Gerlitz return 0; 2116d79b6df6SOr Gerlitz } 2117d79b6df6SOr Gerlitz 21182cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev, 21192cc1cb1dSTonghao Zhang int namespace) 21202cc1cb1dSTonghao Zhang { 21212cc1cb1dSTonghao Zhang if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 21222cc1cb1dSTonghao Zhang return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions); 21232cc1cb1dSTonghao Zhang else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 21242cc1cb1dSTonghao Zhang return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions); 21252cc1cb1dSTonghao Zhang } 21262cc1cb1dSTonghao Zhang 2127d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 2128c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2129c500c86bSPablo Neira Ayuso int namespace, 2130d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 2131d79b6df6SOr Gerlitz { 2132d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 2133d79b6df6SOr Gerlitz 2134c500c86bSPablo Neira Ayuso nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits + 2135c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits; 2136d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2137d79b6df6SOr Gerlitz 21382cc1cb1dSTonghao Zhang max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace); 2139d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 2140d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 2141d79b6df6SOr Gerlitz 2142d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 2143d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 2144d79b6df6SOr Gerlitz return -ENOMEM; 2145d79b6df6SOr Gerlitz 2146218d05ceSTonghao Zhang parse_attr->max_mod_hdr_actions = max_actions; 2147d79b6df6SOr Gerlitz return 0; 2148d79b6df6SOr Gerlitz } 2149d79b6df6SOr Gerlitz 2150d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 2151d79b6df6SOr Gerlitz 2152d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 215373867881SPablo Neira Ayuso const struct flow_action_entry *act, int namespace, 2154e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2155c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2156e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2157d79b6df6SOr Gerlitz { 215873867881SPablo Neira Ayuso u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1; 215973867881SPablo Neira Ayuso int err = -EOPNOTSUPP; 2160d79b6df6SOr Gerlitz u32 mask, val, offset; 216173867881SPablo Neira Ayuso u8 htype; 2162d79b6df6SOr Gerlitz 216373867881SPablo Neira Ayuso htype = act->mangle.htype; 2164d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 2165d79b6df6SOr Gerlitz 216673867881SPablo Neira Ayuso if (htype == FLOW_ACT_MANGLE_UNSPEC) { 216773867881SPablo Neira Ayuso NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded"); 2168d79b6df6SOr Gerlitz goto out_err; 2169d79b6df6SOr Gerlitz } 2170d79b6df6SOr Gerlitz 21712cc1cb1dSTonghao Zhang if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) { 21722cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, 21732cc1cb1dSTonghao Zhang "The pedit offload action is not supported"); 21742cc1cb1dSTonghao Zhang goto out_err; 21752cc1cb1dSTonghao Zhang } 21762cc1cb1dSTonghao Zhang 217773867881SPablo Neira Ayuso mask = act->mangle.mask; 217873867881SPablo Neira Ayuso val = act->mangle.val; 217973867881SPablo Neira Ayuso offset = act->mangle.offset; 2180d79b6df6SOr Gerlitz 2181c500c86bSPablo Neira Ayuso err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]); 2182d79b6df6SOr Gerlitz if (err) 2183d79b6df6SOr Gerlitz goto out_err; 2184c500c86bSPablo Neira Ayuso 2185c500c86bSPablo Neira Ayuso hdrs[cmd].pedits++; 2186d79b6df6SOr Gerlitz 2187c500c86bSPablo Neira Ayuso return 0; 2188c500c86bSPablo Neira Ayuso out_err: 2189c500c86bSPablo Neira Ayuso return err; 2190c500c86bSPablo Neira Ayuso } 2191c500c86bSPablo Neira Ayuso 2192c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace, 2193c500c86bSPablo Neira Ayuso struct mlx5e_tc_flow_parse_attr *parse_attr, 2194c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 219527c11b6bSEli Britstein u32 *action_flags, 2196c500c86bSPablo Neira Ayuso struct netlink_ext_ack *extack) 2197c500c86bSPablo Neira Ayuso { 2198c500c86bSPablo Neira Ayuso struct pedit_headers *cmd_masks; 2199c500c86bSPablo Neira Ayuso int err; 2200c500c86bSPablo Neira Ayuso u8 cmd; 2201c500c86bSPablo Neira Ayuso 2202218d05ceSTonghao Zhang if (!parse_attr->mod_hdr_actions) { 2203c500c86bSPablo Neira Ayuso err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr); 2204d79b6df6SOr Gerlitz if (err) 2205d79b6df6SOr Gerlitz goto out_err; 2206218d05ceSTonghao Zhang } 2207d79b6df6SOr Gerlitz 220827c11b6bSEli Britstein err = offload_pedit_fields(hdrs, parse_attr, action_flags, extack); 2209d79b6df6SOr Gerlitz if (err < 0) 2210d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2211d79b6df6SOr Gerlitz 2212d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 2213c500c86bSPablo Neira Ayuso cmd_masks = &hdrs[cmd].masks; 2214d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 2215e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2216e98bedf5SEli Britstein "attempt to offload an unsupported field"); 2217b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 2218d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 2219d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 2220d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 2221d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2222d79b6df6SOr Gerlitz } 2223d79b6df6SOr Gerlitz } 2224d79b6df6SOr Gerlitz 2225d79b6df6SOr Gerlitz return 0; 2226d79b6df6SOr Gerlitz 2227d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 2228d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 2229d79b6df6SOr Gerlitz out_err: 2230d79b6df6SOr Gerlitz return err; 2231d79b6df6SOr Gerlitz } 2232d79b6df6SOr Gerlitz 2233e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv, 2234e98bedf5SEli Britstein u32 action, 2235e98bedf5SEli Britstein u32 update_flags, 2236e98bedf5SEli Britstein struct netlink_ext_ack *extack) 223726c02749SOr Gerlitz { 223826c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 223926c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 224026c02749SOr Gerlitz 224126c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 224226c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 2243e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2244e98bedf5SEli Britstein "TC csum action is only offloaded with pedit"); 224526c02749SOr Gerlitz netdev_warn(priv->netdev, 224626c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 224726c02749SOr Gerlitz return false; 224826c02749SOr Gerlitz } 224926c02749SOr Gerlitz 225026c02749SOr Gerlitz if (update_flags & ~prot_flags) { 2251e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2252e98bedf5SEli Britstein "can't offload TC csum action for some header/s"); 225326c02749SOr Gerlitz netdev_warn(priv->netdev, 225426c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 225526c02749SOr Gerlitz update_flags); 225626c02749SOr Gerlitz return false; 225726c02749SOr Gerlitz } 225826c02749SOr Gerlitz 225926c02749SOr Gerlitz return true; 226026c02749SOr Gerlitz } 226126c02749SOr Gerlitz 22628998576bSDmytro Linkin struct ip_ttl_word { 22638998576bSDmytro Linkin __u8 ttl; 22648998576bSDmytro Linkin __u8 protocol; 22658998576bSDmytro Linkin __sum16 check; 22668998576bSDmytro Linkin }; 22678998576bSDmytro Linkin 22688998576bSDmytro Linkin struct ipv6_hoplimit_word { 22698998576bSDmytro Linkin __be16 payload_len; 22708998576bSDmytro Linkin __u8 nexthdr; 22718998576bSDmytro Linkin __u8 hop_limit; 22728998576bSDmytro Linkin }; 22738998576bSDmytro Linkin 22748998576bSDmytro Linkin static bool is_action_keys_supported(const struct flow_action_entry *act) 22758998576bSDmytro Linkin { 22768998576bSDmytro Linkin u32 mask, offset; 22778998576bSDmytro Linkin u8 htype; 22788998576bSDmytro Linkin 22798998576bSDmytro Linkin htype = act->mangle.htype; 22808998576bSDmytro Linkin offset = act->mangle.offset; 22818998576bSDmytro Linkin mask = ~act->mangle.mask; 22828998576bSDmytro Linkin /* For IPv4 & IPv6 header check 4 byte word, 22838998576bSDmytro Linkin * to determine that modified fields 22848998576bSDmytro Linkin * are NOT ttl & hop_limit only. 22858998576bSDmytro Linkin */ 22868998576bSDmytro Linkin if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) { 22878998576bSDmytro Linkin struct ip_ttl_word *ttl_word = 22888998576bSDmytro Linkin (struct ip_ttl_word *)&mask; 22898998576bSDmytro Linkin 22908998576bSDmytro Linkin if (offset != offsetof(struct iphdr, ttl) || 22918998576bSDmytro Linkin ttl_word->protocol || 22928998576bSDmytro Linkin ttl_word->check) { 22938998576bSDmytro Linkin return true; 22948998576bSDmytro Linkin } 22958998576bSDmytro Linkin } else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) { 22968998576bSDmytro Linkin struct ipv6_hoplimit_word *hoplimit_word = 22978998576bSDmytro Linkin (struct ipv6_hoplimit_word *)&mask; 22988998576bSDmytro Linkin 22998998576bSDmytro Linkin if (offset != offsetof(struct ipv6hdr, payload_len) || 23008998576bSDmytro Linkin hoplimit_word->payload_len || 23018998576bSDmytro Linkin hoplimit_word->nexthdr) { 23028998576bSDmytro Linkin return true; 23038998576bSDmytro Linkin } 23048998576bSDmytro Linkin } 23058998576bSDmytro Linkin return false; 23068998576bSDmytro Linkin } 23078998576bSDmytro Linkin 2308bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 230973867881SPablo Neira Ayuso struct flow_action *flow_action, 23101651925dSGuy Shattah u32 actions, 2311e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2312bdd66ac0SOr Gerlitz { 231373867881SPablo Neira Ayuso const struct flow_action_entry *act; 2314bdd66ac0SOr Gerlitz bool modify_ip_header; 2315bdd66ac0SOr Gerlitz void *headers_v; 2316bdd66ac0SOr Gerlitz u16 ethertype; 23178998576bSDmytro Linkin u8 ip_proto; 231873867881SPablo Neira Ayuso int i; 2319bdd66ac0SOr Gerlitz 23208377629eSEli Britstein headers_v = get_match_headers_value(actions, spec); 2321bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 2322bdd66ac0SOr Gerlitz 2323bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 2324bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 2325bdd66ac0SOr Gerlitz goto out_ok; 2326bdd66ac0SOr Gerlitz 2327bdd66ac0SOr Gerlitz modify_ip_header = false; 232873867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 232973867881SPablo Neira Ayuso if (act->id != FLOW_ACTION_MANGLE && 233073867881SPablo Neira Ayuso act->id != FLOW_ACTION_ADD) 2331bdd66ac0SOr Gerlitz continue; 2332bdd66ac0SOr Gerlitz 23338998576bSDmytro Linkin if (is_action_keys_supported(act)) { 2334bdd66ac0SOr Gerlitz modify_ip_header = true; 2335bdd66ac0SOr Gerlitz break; 2336bdd66ac0SOr Gerlitz } 2337bdd66ac0SOr Gerlitz } 2338bdd66ac0SOr Gerlitz 2339bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 23401ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 23411ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 2342e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2343e98bedf5SEli Britstein "can't offload re-write of non TCP/UDP"); 2344bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 2345bdd66ac0SOr Gerlitz return false; 2346bdd66ac0SOr Gerlitz } 2347bdd66ac0SOr Gerlitz 2348bdd66ac0SOr Gerlitz out_ok: 2349bdd66ac0SOr Gerlitz return true; 2350bdd66ac0SOr Gerlitz } 2351bdd66ac0SOr Gerlitz 2352bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 235373867881SPablo Neira Ayuso struct flow_action *flow_action, 2354bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2355e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2356e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2357bdd66ac0SOr Gerlitz { 2358bdd66ac0SOr Gerlitz u32 actions; 2359bdd66ac0SOr Gerlitz 2360bdd66ac0SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 2361bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2362bdd66ac0SOr Gerlitz else 2363bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2364bdd66ac0SOr Gerlitz 23657e29392eSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_EGRESS && 236635a605dbSEli Britstein !((actions & MLX5_FLOW_CONTEXT_ACTION_DECAP) || 236735a605dbSEli Britstein (actions & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP))) 23687e29392eSRoi Dayan return false; 23697e29392eSRoi Dayan 2370bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 237173867881SPablo Neira Ayuso return modify_header_match_supported(&parse_attr->spec, 2372a655fe9fSDavid S. Miller flow_action, actions, 2373e98bedf5SEli Britstein extack); 2374bdd66ac0SOr Gerlitz 2375bdd66ac0SOr Gerlitz return true; 2376bdd66ac0SOr Gerlitz } 2377bdd66ac0SOr Gerlitz 23785c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 23795c65c564SOr Gerlitz { 23805c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 2381816f6706SOr Gerlitz u64 fsystem_guid, psystem_guid; 23825c65c564SOr Gerlitz 23835c65c564SOr Gerlitz fmdev = priv->mdev; 23845c65c564SOr Gerlitz pmdev = peer_priv->mdev; 23855c65c564SOr Gerlitz 238659c9d35eSAlaa Hleihel fsystem_guid = mlx5_query_nic_system_image_guid(fmdev); 238759c9d35eSAlaa Hleihel psystem_guid = mlx5_query_nic_system_image_guid(pmdev); 23885c65c564SOr Gerlitz 2389816f6706SOr Gerlitz return (fsystem_guid == psystem_guid); 23905c65c564SOr Gerlitz } 23915c65c564SOr Gerlitz 2392bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace, 2393bdc837eeSEli Britstein const struct flow_action_entry *act, 2394bdc837eeSEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2395bdc837eeSEli Britstein struct pedit_headers_action *hdrs, 2396bdc837eeSEli Britstein u32 *action, struct netlink_ext_ack *extack) 2397bdc837eeSEli Britstein { 2398bdc837eeSEli Britstein u16 mask16 = VLAN_VID_MASK; 2399bdc837eeSEli Britstein u16 val16 = act->vlan.vid & VLAN_VID_MASK; 2400bdc837eeSEli Britstein const struct flow_action_entry pedit_act = { 2401bdc837eeSEli Britstein .id = FLOW_ACTION_MANGLE, 2402bdc837eeSEli Britstein .mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH, 2403bdc837eeSEli Britstein .mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI), 2404bdc837eeSEli Britstein .mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16), 2405bdc837eeSEli Britstein .mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16), 2406bdc837eeSEli Britstein }; 24076fca9d1eSEli Britstein u8 match_prio_mask, match_prio_val; 2408bf2f3bcaSEli Britstein void *headers_c, *headers_v; 2409bdc837eeSEli Britstein int err; 2410bdc837eeSEli Britstein 2411bf2f3bcaSEli Britstein headers_c = get_match_headers_criteria(*action, &parse_attr->spec); 2412bf2f3bcaSEli Britstein headers_v = get_match_headers_value(*action, &parse_attr->spec); 2413bf2f3bcaSEli Britstein 2414bf2f3bcaSEli Britstein if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) && 2415bf2f3bcaSEli Britstein MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) { 2416bf2f3bcaSEli Britstein NL_SET_ERR_MSG_MOD(extack, 2417bf2f3bcaSEli Britstein "VLAN rewrite action must have VLAN protocol match"); 2418bf2f3bcaSEli Britstein return -EOPNOTSUPP; 2419bf2f3bcaSEli Britstein } 2420bf2f3bcaSEli Britstein 24216fca9d1eSEli Britstein match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 24226fca9d1eSEli Britstein match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 24236fca9d1eSEli Britstein if (act->vlan.prio != (match_prio_val & match_prio_mask)) { 24246fca9d1eSEli Britstein NL_SET_ERR_MSG_MOD(extack, 24256fca9d1eSEli Britstein "Changing VLAN prio is not supported"); 2426bdc837eeSEli Britstein return -EOPNOTSUPP; 2427bdc837eeSEli Britstein } 2428bdc837eeSEli Britstein 2429bdc837eeSEli Britstein err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr, 2430bdc837eeSEli Britstein hdrs, NULL); 2431bdc837eeSEli Britstein *action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2432bdc837eeSEli Britstein 2433bdc837eeSEli Britstein return err; 2434bdc837eeSEli Britstein } 2435bdc837eeSEli Britstein 24360bac1194SEli Britstein static int 24370bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv, 24380bac1194SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 24390bac1194SEli Britstein struct pedit_headers_action *hdrs, 24400bac1194SEli Britstein u32 *action, struct netlink_ext_ack *extack) 24410bac1194SEli Britstein { 24420bac1194SEli Britstein const struct flow_action_entry prio_tag_act = { 24430bac1194SEli Britstein .vlan.vid = 0, 24440bac1194SEli Britstein .vlan.prio = 24450bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 24460bac1194SEli Britstein get_match_headers_value(*action, 24470bac1194SEli Britstein &parse_attr->spec), 24480bac1194SEli Britstein first_prio) & 24490bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 24500bac1194SEli Britstein get_match_headers_criteria(*action, 24510bac1194SEli Britstein &parse_attr->spec), 24520bac1194SEli Britstein first_prio), 24530bac1194SEli Britstein }; 24540bac1194SEli Britstein 24550bac1194SEli Britstein return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB, 24560bac1194SEli Britstein &prio_tag_act, parse_attr, hdrs, action, 24570bac1194SEli Britstein extack); 24580bac1194SEli Britstein } 24590bac1194SEli Britstein 246073867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv, 246173867881SPablo Neira Ayuso struct flow_action *flow_action, 2462aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2463e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2464e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2465e3a2b7edSAmir Vadai { 2466aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 246773867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 246873867881SPablo Neira Ayuso const struct flow_action_entry *act; 24691cab1cd7SOr Gerlitz u32 action = 0; 2470244cd96aSCong Wang int err, i; 2471e3a2b7edSAmir Vadai 247273867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 2473e3a2b7edSAmir Vadai return -EINVAL; 2474e3a2b7edSAmir Vadai 24753bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2476e3a2b7edSAmir Vadai 247773867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 247873867881SPablo Neira Ayuso switch (act->id) { 247973867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 24801cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2481aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2482aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 24831cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 248473867881SPablo Neira Ayuso break; 248573867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 248673867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 248773867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL, 2488c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 24892f4fe4caSOr Gerlitz if (err) 24902f4fe4caSOr Gerlitz return err; 24912f4fe4caSOr Gerlitz 24921cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 24932f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 249473867881SPablo Neira Ayuso break; 2495bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2496bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2497bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_KERNEL, 2498bdc837eeSEli Britstein act, parse_attr, hdrs, 2499bdc837eeSEli Britstein &action, extack); 2500bdc837eeSEli Britstein if (err) 2501bdc837eeSEli Britstein return err; 2502bdc837eeSEli Britstein 2503bdc837eeSEli Britstein break; 250473867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 25051cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 250673867881SPablo Neira Ayuso act->csum_flags, 2507e98bedf5SEli Britstein extack)) 250873867881SPablo Neira Ayuso break; 250926c02749SOr Gerlitz 251026c02749SOr Gerlitz return -EOPNOTSUPP; 251173867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: { 251273867881SPablo Neira Ayuso struct net_device *peer_dev = act->dev; 25135c65c564SOr Gerlitz 25145c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 25155c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 251698b66cb1SEli Britstein parse_attr->mirred_ifindex[0] = peer_dev->ifindex; 25175c65c564SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN; 25181cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 25195c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 25205c65c564SOr Gerlitz } else { 2521e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2522e98bedf5SEli Britstein "device is not on same HW, can't offload"); 25235c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 25245c65c564SOr Gerlitz peer_dev->name); 25255c65c564SOr Gerlitz return -EINVAL; 25265c65c564SOr Gerlitz } 25275c65c564SOr Gerlitz } 252873867881SPablo Neira Ayuso break; 252973867881SPablo Neira Ayuso case FLOW_ACTION_MARK: { 253073867881SPablo Neira Ayuso u32 mark = act->mark; 2531e3a2b7edSAmir Vadai 2532e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2533e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2534e98bedf5SEli Britstein "Bad flow mark - only 16 bit is supported"); 2535e3a2b7edSAmir Vadai return -EINVAL; 2536e3a2b7edSAmir Vadai } 2537e3a2b7edSAmir Vadai 25383bc4b7bfSOr Gerlitz attr->flow_tag = mark; 25391cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2540e3a2b7edSAmir Vadai } 254173867881SPablo Neira Ayuso break; 254273867881SPablo Neira Ayuso default: 25432cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 25442cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 2545e3a2b7edSAmir Vadai } 254673867881SPablo Neira Ayuso } 2547e3a2b7edSAmir Vadai 2548c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2549c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 2550c500c86bSPablo Neira Ayuso err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL, 255127c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2552c500c86bSPablo Neira Ayuso if (err) 2553c500c86bSPablo Neira Ayuso return err; 255427c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 255527c11b6bSEli Britstein * flag. 255627c11b6bSEli Britstein */ 2557e7739a60SEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 255827c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2559e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 2560e7739a60SEli Britstein } 2561c500c86bSPablo Neira Ayuso } 2562c500c86bSPablo Neira Ayuso 25631cab1cd7SOr Gerlitz attr->action = action; 256473867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 2565bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2566bdd66ac0SOr Gerlitz 2567e3a2b7edSAmir Vadai return 0; 2568e3a2b7edSAmir Vadai } 2569e3a2b7edSAmir Vadai 25707f1a546eSEli Britstein struct encap_key { 25711f6da306SYevgeny Kliteynik const struct ip_tunnel_key *ip_tun_key; 2572d386939aSYevgeny Kliteynik struct mlx5e_tc_tunnel *tc_tunnel; 25737f1a546eSEli Britstein }; 25747f1a546eSEli Britstein 25757f1a546eSEli Britstein static inline int cmp_encap_info(struct encap_key *a, 25767f1a546eSEli Britstein struct encap_key *b) 2577a54e20b4SHadar Hen Zion { 25787f1a546eSEli Britstein return memcmp(a->ip_tun_key, b->ip_tun_key, sizeof(*a->ip_tun_key)) || 2579d386939aSYevgeny Kliteynik a->tc_tunnel->tunnel_type != b->tc_tunnel->tunnel_type; 2580a54e20b4SHadar Hen Zion } 2581a54e20b4SHadar Hen Zion 25827f1a546eSEli Britstein static inline int hash_encap_info(struct encap_key *key) 2583a54e20b4SHadar Hen Zion { 25847f1a546eSEli Britstein return jhash(key->ip_tun_key, sizeof(*key->ip_tun_key), 2585d386939aSYevgeny Kliteynik key->tc_tunnel->tunnel_type); 2586a54e20b4SHadar Hen Zion } 2587a54e20b4SHadar Hen Zion 2588a54e20b4SHadar Hen Zion 2589b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2590b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2591b1d90e6bSRabie Loulou { 2592b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2593b1d90e6bSRabie Loulou 2594b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2595b1d90e6bSRabie Loulou 2596b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 259768931c7dSRoi Dayan mlx5e_eswitch_rep(priv->netdev) && 259868931c7dSRoi Dayan mlx5e_eswitch_rep(peer_netdev) && 259968931c7dSRoi Dayan same_hw_devs(priv, peer_priv)); 2600b1d90e6bSRabie Loulou } 2601b1d90e6bSRabie Loulou 2602ce99f6b9SOr Gerlitz 260354c177caSOz Shlomo 2604a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 2605e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2606733d4f36SRoi Dayan struct net_device *mirred_dev, 2607733d4f36SRoi Dayan int out_index, 26088c4dc42bSEli Britstein struct netlink_ext_ack *extack, 26090ad060eeSRoi Dayan struct net_device **encap_dev, 26100ad060eeSRoi Dayan bool *encap_valid) 261103a9d11eSOr Gerlitz { 2612a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 261345247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 2614733d4f36SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 26151f6da306SYevgeny Kliteynik const struct ip_tunnel_info *tun_info; 26167f1a546eSEli Britstein struct encap_key key, e_key; 2617c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 2618733d4f36SRoi Dayan unsigned short family; 2619a54e20b4SHadar Hen Zion uintptr_t hash_key; 2620a54e20b4SHadar Hen Zion bool found = false; 262154c177caSOz Shlomo int err = 0; 2622a54e20b4SHadar Hen Zion 2623733d4f36SRoi Dayan parse_attr = attr->parse_attr; 26241f6da306SYevgeny Kliteynik tun_info = parse_attr->tun_info[out_index]; 2625733d4f36SRoi Dayan family = ip_tunnel_info_af(tun_info); 26267f1a546eSEli Britstein key.ip_tun_key = &tun_info->key; 2627d386939aSYevgeny Kliteynik key.tc_tunnel = mlx5e_get_tc_tun(mirred_dev); 2628733d4f36SRoi Dayan 26297f1a546eSEli Britstein hash_key = hash_encap_info(&key); 2630a54e20b4SHadar Hen Zion 2631a54e20b4SHadar Hen Zion hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2632a54e20b4SHadar Hen Zion encap_hlist, hash_key) { 26331f6da306SYevgeny Kliteynik e_key.ip_tun_key = &e->tun_info->key; 2634d386939aSYevgeny Kliteynik e_key.tc_tunnel = e->tunnel; 26357f1a546eSEli Britstein if (!cmp_encap_info(&e_key, &key)) { 2636a54e20b4SHadar Hen Zion found = true; 2637a54e20b4SHadar Hen Zion break; 2638a54e20b4SHadar Hen Zion } 2639a54e20b4SHadar Hen Zion } 2640a54e20b4SHadar Hen Zion 2641b2812089SVlad Buslov /* must verify if encap is valid or not */ 264245247bf2SOr Gerlitz if (found) 264345247bf2SOr Gerlitz goto attach_flow; 2644a54e20b4SHadar Hen Zion 2645a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 2646a54e20b4SHadar Hen Zion if (!e) 2647a54e20b4SHadar Hen Zion return -ENOMEM; 2648a54e20b4SHadar Hen Zion 26491f6da306SYevgeny Kliteynik e->tun_info = tun_info; 2650101f4de9SOz Shlomo err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack); 265154c177caSOz Shlomo if (err) 265254c177caSOz Shlomo goto out_err; 265354c177caSOz Shlomo 2654a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 2655a54e20b4SHadar Hen Zion 2656ce99f6b9SOr Gerlitz if (family == AF_INET) 2657101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e); 2658ce99f6b9SOr Gerlitz else if (family == AF_INET6) 2659101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e); 2660ce99f6b9SOr Gerlitz 26610ad060eeSRoi Dayan if (err) 2662a54e20b4SHadar Hen Zion goto out_err; 2663a54e20b4SHadar Hen Zion 2664a54e20b4SHadar Hen Zion hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 2665a54e20b4SHadar Hen Zion 266645247bf2SOr Gerlitz attach_flow: 26678c4dc42bSEli Britstein list_add(&flow->encaps[out_index].list, &e->flows); 26688c4dc42bSEli Britstein flow->encaps[out_index].index = out_index; 266945247bf2SOr Gerlitz *encap_dev = e->out_dev; 26708c4dc42bSEli Britstein if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 26718c4dc42bSEli Britstein attr->dests[out_index].encap_id = e->encap_id; 26728c4dc42bSEli Britstein attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 26730ad060eeSRoi Dayan *encap_valid = true; 26748c4dc42bSEli Britstein } else { 26750ad060eeSRoi Dayan *encap_valid = false; 26768c4dc42bSEli Britstein } 267745247bf2SOr Gerlitz 2678232c0013SHadar Hen Zion return err; 2679a54e20b4SHadar Hen Zion 2680a54e20b4SHadar Hen Zion out_err: 2681a54e20b4SHadar Hen Zion kfree(e); 2682a54e20b4SHadar Hen Zion return err; 2683a54e20b4SHadar Hen Zion } 2684a54e20b4SHadar Hen Zion 26851482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 268673867881SPablo Neira Ayuso const struct flow_action_entry *act, 26871482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 26881482bd3dSJianbo Liu u32 *action) 26891482bd3dSJianbo Liu { 2690cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 2691cc495188SJianbo Liu 2692cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 26931482bd3dSJianbo Liu return -EOPNOTSUPP; 2694cc495188SJianbo Liu 269573867881SPablo Neira Ayuso switch (act->id) { 269673867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 2697cc495188SJianbo Liu if (vlan_idx) { 2698cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2699cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2700cc495188SJianbo Liu return -EOPNOTSUPP; 2701cc495188SJianbo Liu 2702cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 2703cc495188SJianbo Liu } else { 2704cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 2705cc495188SJianbo Liu } 270673867881SPablo Neira Ayuso break; 270773867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 270873867881SPablo Neira Ayuso attr->vlan_vid[vlan_idx] = act->vlan.vid; 270973867881SPablo Neira Ayuso attr->vlan_prio[vlan_idx] = act->vlan.prio; 271073867881SPablo Neira Ayuso attr->vlan_proto[vlan_idx] = act->vlan.proto; 2711cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 2712cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 2713cc495188SJianbo Liu 2714cc495188SJianbo Liu if (vlan_idx) { 2715cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2716cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2717cc495188SJianbo Liu return -EOPNOTSUPP; 2718cc495188SJianbo Liu 2719cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 2720cc495188SJianbo Liu } else { 2721cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 272273867881SPablo Neira Ayuso (act->vlan.proto != htons(ETH_P_8021Q) || 272373867881SPablo Neira Ayuso act->vlan.prio)) 2724cc495188SJianbo Liu return -EOPNOTSUPP; 2725cc495188SJianbo Liu 2726cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 27271482bd3dSJianbo Liu } 272873867881SPablo Neira Ayuso break; 272973867881SPablo Neira Ayuso default: 2730bdc837eeSEli Britstein return -EINVAL; 27311482bd3dSJianbo Liu } 27321482bd3dSJianbo Liu 2733cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 2734cc495188SJianbo Liu 27351482bd3dSJianbo Liu return 0; 27361482bd3dSJianbo Liu } 27371482bd3dSJianbo Liu 2738278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv, 2739278748a9SEli Britstein struct mlx5_esw_flow_attr *attr, 2740278748a9SEli Britstein struct net_device **out_dev, 2741278748a9SEli Britstein u32 *action) 2742278748a9SEli Britstein { 2743278748a9SEli Britstein struct net_device *vlan_dev = *out_dev; 2744278748a9SEli Britstein struct flow_action_entry vlan_act = { 2745278748a9SEli Britstein .id = FLOW_ACTION_VLAN_PUSH, 2746278748a9SEli Britstein .vlan.vid = vlan_dev_vlan_id(vlan_dev), 2747278748a9SEli Britstein .vlan.proto = vlan_dev_vlan_proto(vlan_dev), 2748278748a9SEli Britstein .vlan.prio = 0, 2749278748a9SEli Britstein }; 2750278748a9SEli Britstein int err; 2751278748a9SEli Britstein 2752278748a9SEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 2753278748a9SEli Britstein if (err) 2754278748a9SEli Britstein return err; 2755278748a9SEli Britstein 2756278748a9SEli Britstein *out_dev = dev_get_by_index_rcu(dev_net(vlan_dev), 2757278748a9SEli Britstein dev_get_iflink(vlan_dev)); 2758278748a9SEli Britstein if (is_vlan_dev(*out_dev)) 2759278748a9SEli Britstein err = add_vlan_push_action(priv, attr, out_dev, action); 2760278748a9SEli Britstein 2761278748a9SEli Britstein return err; 2762278748a9SEli Britstein } 2763278748a9SEli Britstein 276435a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv, 276535a605dbSEli Britstein struct mlx5_esw_flow_attr *attr, 276635a605dbSEli Britstein u32 *action) 276735a605dbSEli Britstein { 276835a605dbSEli Britstein int nest_level = vlan_get_encap_level(attr->parse_attr->filter_dev); 276935a605dbSEli Britstein struct flow_action_entry vlan_act = { 277035a605dbSEli Britstein .id = FLOW_ACTION_VLAN_POP, 277135a605dbSEli Britstein }; 277235a605dbSEli Britstein int err = 0; 277335a605dbSEli Britstein 277435a605dbSEli Britstein while (nest_level--) { 277535a605dbSEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 277635a605dbSEli Britstein if (err) 277735a605dbSEli Britstein return err; 277835a605dbSEli Britstein } 277935a605dbSEli Britstein 278035a605dbSEli Britstein return err; 278135a605dbSEli Britstein } 278235a605dbSEli Britstein 278373867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv, 278473867881SPablo Neira Ayuso struct flow_action *flow_action, 2785e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2786e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2787a54e20b4SHadar Hen Zion { 278873867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 2789bf07aa73SPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2790ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 27916f9af8ffSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 27921d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 279373867881SPablo Neira Ayuso const struct ip_tunnel_info *info = NULL; 279473867881SPablo Neira Ayuso const struct flow_action_entry *act; 2795a54e20b4SHadar Hen Zion bool encap = false; 27961cab1cd7SOr Gerlitz u32 action = 0; 2797244cd96aSCong Wang int err, i; 279803a9d11eSOr Gerlitz 279973867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 280003a9d11eSOr Gerlitz return -EINVAL; 280103a9d11eSOr Gerlitz 28021d447a39SSaeed Mahameed attr->in_rep = rpriv->rep; 280310ff5359SShahar Klein attr->in_mdev = priv->mdev; 280403a9d11eSOr Gerlitz 280573867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 280673867881SPablo Neira Ayuso switch (act->id) { 280773867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 28081cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 280903a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 281073867881SPablo Neira Ayuso break; 281173867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 281273867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 281373867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB, 2814c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 2815d7e75a32SOr Gerlitz if (err) 2816d7e75a32SOr Gerlitz return err; 2817d7e75a32SOr Gerlitz 28181cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2819e85e02baSEli Britstein attr->split_count = attr->out_count; 282073867881SPablo Neira Ayuso break; 282173867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 28221cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 282373867881SPablo Neira Ayuso act->csum_flags, extack)) 282473867881SPablo Neira Ayuso break; 282526c02749SOr Gerlitz 282626c02749SOr Gerlitz return -EOPNOTSUPP; 282773867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: 282873867881SPablo Neira Ayuso case FLOW_ACTION_MIRRED: { 282903a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 2830592d3651SChris Mi struct net_device *out_dev; 283103a9d11eSOr Gerlitz 283273867881SPablo Neira Ayuso out_dev = act->dev; 2833ef381359SOz Shlomo if (!out_dev) { 2834ef381359SOz Shlomo /* out_dev is NULL when filters with 2835ef381359SOz Shlomo * non-existing mirred device are replayed to 2836ef381359SOz Shlomo * the driver. 2837ef381359SOz Shlomo */ 2838ef381359SOz Shlomo return -EINVAL; 2839ef381359SOz Shlomo } 284003a9d11eSOr Gerlitz 2841592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 2842e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2843e98bedf5SEli Britstein "can't support more output ports, can't offload forwarding"); 2844592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 2845592d3651SChris Mi attr->out_count); 2846592d3651SChris Mi return -EOPNOTSUPP; 2847592d3651SChris Mi } 2848592d3651SChris Mi 2849f493f155SEli Britstein action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2850f493f155SEli Britstein MLX5_FLOW_CONTEXT_ACTION_COUNT; 28516dcfa234SFlorian Fainelli if (netdev_port_same_parent_id(priv->netdev, 2852b1d90e6bSRabie Loulou out_dev) || 2853b1d90e6bSRabie Loulou is_merged_eswitch_dev(priv, out_dev)) { 28547ba58ba7SRabie Loulou struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 28557ba58ba7SRabie Loulou struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH); 28567ba58ba7SRabie Loulou struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev); 28577ba58ba7SRabie Loulou 28587ba58ba7SRabie Loulou if (uplink_upper && 28597ba58ba7SRabie Loulou netif_is_lag_master(uplink_upper) && 28607ba58ba7SRabie Loulou uplink_upper == out_dev) 28617ba58ba7SRabie Loulou out_dev = uplink_dev; 28627ba58ba7SRabie Loulou 2863278748a9SEli Britstein if (is_vlan_dev(out_dev)) { 2864278748a9SEli Britstein err = add_vlan_push_action(priv, attr, 2865278748a9SEli Britstein &out_dev, 2866278748a9SEli Britstein &action); 2867278748a9SEli Britstein if (err) 2868278748a9SEli Britstein return err; 2869278748a9SEli Britstein } 287035a605dbSEli Britstein if (is_vlan_dev(parse_attr->filter_dev)) { 287135a605dbSEli Britstein err = add_vlan_pop_action(priv, attr, 287235a605dbSEli Britstein &action); 287335a605dbSEli Britstein if (err) 287435a605dbSEli Britstein return err; 287535a605dbSEli Britstein } 2876278748a9SEli Britstein 2877a0646c88SEli Britstein if (!mlx5e_eswitch_rep(out_dev)) 2878a0646c88SEli Britstein return -EOPNOTSUPP; 2879a0646c88SEli Britstein 288003a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 28811d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 2882df65a573SEli Britstein attr->dests[attr->out_count].rep = rpriv->rep; 2883df65a573SEli Britstein attr->dests[attr->out_count].mdev = out_priv->mdev; 2884df65a573SEli Britstein attr->out_count++; 2885a54e20b4SHadar Hen Zion } else if (encap) { 28868c4dc42bSEli Britstein parse_attr->mirred_ifindex[attr->out_count] = 28878c4dc42bSEli Britstein out_dev->ifindex; 28881f6da306SYevgeny Kliteynik parse_attr->tun_info[attr->out_count] = info; 28898c4dc42bSEli Britstein encap = false; 2890f493f155SEli Britstein attr->dests[attr->out_count].flags |= 2891f493f155SEli Britstein MLX5_ESW_DEST_ENCAP; 28921cc26d74SEli Britstein attr->out_count++; 2893df65a573SEli Britstein /* attr->dests[].rep is resolved when we 2894df65a573SEli Britstein * handle encap 2895df65a573SEli Britstein */ 2896ef381359SOz Shlomo } else if (parse_attr->filter_dev != priv->netdev) { 2897ef381359SOz Shlomo /* All mlx5 devices are called to configure 2898ef381359SOz Shlomo * high level device filters. Therefore, the 2899ef381359SOz Shlomo * *attempt* to install a filter on invalid 2900ef381359SOz Shlomo * eswitch should not trigger an explicit error 2901ef381359SOz Shlomo */ 2902ef381359SOz Shlomo return -EINVAL; 2903a54e20b4SHadar Hen Zion } else { 2904e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2905e98bedf5SEli Britstein "devices are not on same switch HW, can't offload forwarding"); 2906a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 2907a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 2908a54e20b4SHadar Hen Zion return -EINVAL; 2909a54e20b4SHadar Hen Zion } 2910a54e20b4SHadar Hen Zion } 291173867881SPablo Neira Ayuso break; 291273867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_ENCAP: 291373867881SPablo Neira Ayuso info = act->tunnel; 2914a54e20b4SHadar Hen Zion if (info) 2915a54e20b4SHadar Hen Zion encap = true; 2916a54e20b4SHadar Hen Zion else 2917a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 291803a9d11eSOr Gerlitz 291973867881SPablo Neira Ayuso break; 292073867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 292173867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 292276b496b1SEli Britstein if (act->id == FLOW_ACTION_VLAN_PUSH && 292376b496b1SEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) { 292476b496b1SEli Britstein /* Replace vlan pop+push with vlan modify */ 292576b496b1SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 292676b496b1SEli Britstein err = add_vlan_rewrite_action(priv, 292776b496b1SEli Britstein MLX5_FLOW_NAMESPACE_FDB, 292876b496b1SEli Britstein act, parse_attr, hdrs, 292976b496b1SEli Britstein &action, extack); 293076b496b1SEli Britstein } else { 293173867881SPablo Neira Ayuso err = parse_tc_vlan_action(priv, act, attr, &action); 293276b496b1SEli Britstein } 29331482bd3dSJianbo Liu if (err) 29341482bd3dSJianbo Liu return err; 29351482bd3dSJianbo Liu 2936e85e02baSEli Britstein attr->split_count = attr->out_count; 293773867881SPablo Neira Ayuso break; 2938bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2939bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2940bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_FDB, 2941bdc837eeSEli Britstein act, parse_attr, hdrs, 2942bdc837eeSEli Britstein &action, extack); 2943bdc837eeSEli Britstein if (err) 2944bdc837eeSEli Britstein return err; 2945bdc837eeSEli Britstein 2946bdc837eeSEli Britstein attr->split_count = attr->out_count; 2947bdc837eeSEli Britstein break; 294873867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_DECAP: 29491cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 295073867881SPablo Neira Ayuso break; 295173867881SPablo Neira Ayuso case FLOW_ACTION_GOTO: { 295273867881SPablo Neira Ayuso u32 dest_chain = act->chain_index; 2953bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 2954bf07aa73SPaul Blakey 2955bf07aa73SPaul Blakey if (dest_chain <= attr->chain) { 2956bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported"); 2957bf07aa73SPaul Blakey return -EOPNOTSUPP; 2958bf07aa73SPaul Blakey } 2959bf07aa73SPaul Blakey if (dest_chain > max_chain) { 2960bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range"); 2961bf07aa73SPaul Blakey return -EOPNOTSUPP; 2962bf07aa73SPaul Blakey } 2963e88afe75SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 2964bf07aa73SPaul Blakey attr->dest_chain = dest_chain; 296573867881SPablo Neira Ayuso break; 2966bf07aa73SPaul Blakey } 296773867881SPablo Neira Ayuso default: 29682cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 29692cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 297003a9d11eSOr Gerlitz } 297173867881SPablo Neira Ayuso } 2972bdd66ac0SOr Gerlitz 29730bac1194SEli Britstein if (MLX5_CAP_GEN(esw->dev, prio_tag_required) && 29740bac1194SEli Britstein action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) { 29750bac1194SEli Britstein /* For prio tag mode, replace vlan pop with rewrite vlan prio 29760bac1194SEli Britstein * tag rewrite. 29770bac1194SEli Britstein */ 29780bac1194SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 29790bac1194SEli Britstein err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs, 29800bac1194SEli Britstein &action, extack); 29810bac1194SEli Britstein if (err) 29820bac1194SEli Britstein return err; 29830bac1194SEli Britstein } 29840bac1194SEli Britstein 2985c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2986c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 298784be899fSTonghao Zhang err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB, 298827c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2989c500c86bSPablo Neira Ayuso if (err) 2990c500c86bSPablo Neira Ayuso return err; 299127c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 299227c11b6bSEli Britstein * flag. we might have set split_count either by pedit or 299327c11b6bSEli Britstein * pop/push. if there is no pop/push either, reset it too. 299427c11b6bSEli Britstein */ 299527c11b6bSEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 299627c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2997e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 299827c11b6bSEli Britstein if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 299927c11b6bSEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH))) 300027c11b6bSEli Britstein attr->split_count = 0; 300127c11b6bSEli Britstein } 3002c500c86bSPablo Neira Ayuso } 3003c500c86bSPablo Neira Ayuso 30041cab1cd7SOr Gerlitz attr->action = action; 300573867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 3006bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 3007bdd66ac0SOr Gerlitz 3008e88afe75SOr Gerlitz if (attr->dest_chain) { 3009e88afe75SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 3010e88afe75SOr Gerlitz NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported"); 3011e88afe75SOr Gerlitz return -EOPNOTSUPP; 3012e88afe75SOr Gerlitz } 3013e88afe75SOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 3014e88afe75SOr Gerlitz } 3015e88afe75SOr Gerlitz 3016e85e02baSEli Britstein if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 3017e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3018e98bedf5SEli Britstein "current firmware doesn't support split rule for port mirroring"); 3019592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 3020592d3651SChris Mi return -EOPNOTSUPP; 3021592d3651SChris Mi } 3022592d3651SChris Mi 302331c8eba5SOr Gerlitz return 0; 302403a9d11eSOr Gerlitz } 302503a9d11eSOr Gerlitz 30265dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags) 302760bd4af8SOr Gerlitz { 30285dbe906fSPaul Blakey u16 __flow_flags = 0; 302960bd4af8SOr Gerlitz 303060bd4af8SOr Gerlitz if (flags & MLX5E_TC_INGRESS) 303160bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_INGRESS; 303260bd4af8SOr Gerlitz if (flags & MLX5E_TC_EGRESS) 303360bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_EGRESS; 303460bd4af8SOr Gerlitz 3035d9ee0491SOr Gerlitz if (flags & MLX5E_TC_ESW_OFFLOAD) 3036d9ee0491SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_ESWITCH; 3037d9ee0491SOr Gerlitz if (flags & MLX5E_TC_NIC_OFFLOAD) 3038d9ee0491SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_NIC; 3039d9ee0491SOr Gerlitz 304060bd4af8SOr Gerlitz *flow_flags = __flow_flags; 304160bd4af8SOr Gerlitz } 304260bd4af8SOr Gerlitz 304305866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 304405866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 304505866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 304605866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 304705866c82SOr Gerlitz .automatic_shrinking = true, 304805866c82SOr Gerlitz }; 304905866c82SOr Gerlitz 3050d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags) 305105866c82SOr Gerlitz { 3052655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3053655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 3054655dc3d2SOr Gerlitz 3055d9ee0491SOr Gerlitz if (flags & MLX5E_TC_ESW_OFFLOAD) { 3056655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 3057ec1366c2SOz Shlomo return &uplink_rpriv->uplink_priv.tc_ht; 3058d9ee0491SOr Gerlitz } else /* NIC offload */ 305905866c82SOr Gerlitz return &priv->fs.tc.ht; 306005866c82SOr Gerlitz } 306105866c82SOr Gerlitz 306204de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow) 306304de7ddaSRoi Dayan { 30641418ddd9SAviv Heller struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3065b05af6aaSBodong Wang bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK && 30661418ddd9SAviv Heller flow->flags & MLX5E_TC_FLOW_INGRESS; 30671418ddd9SAviv Heller bool act_is_encap = !!(attr->action & 30681418ddd9SAviv Heller MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT); 30691418ddd9SAviv Heller bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom, 30701418ddd9SAviv Heller MLX5_DEVCOM_ESW_OFFLOADS); 30711418ddd9SAviv Heller 307210fbb1cdSRoi Dayan if (!esw_paired) 307310fbb1cdSRoi Dayan return false; 307410fbb1cdSRoi Dayan 307510fbb1cdSRoi Dayan if ((mlx5_lag_is_sriov(attr->in_mdev) || 307610fbb1cdSRoi Dayan mlx5_lag_is_multipath(attr->in_mdev)) && 307710fbb1cdSRoi Dayan (is_rep_ingress || act_is_encap)) 307810fbb1cdSRoi Dayan return true; 307910fbb1cdSRoi Dayan 308010fbb1cdSRoi Dayan return false; 308104de7ddaSRoi Dayan } 308204de7ddaSRoi Dayan 3083a88780a9SRoi Dayan static int 3084a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size, 30855dbe906fSPaul Blakey struct tc_cls_flower_offload *f, u16 flow_flags, 3086a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr **__parse_attr, 3087a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3088e3a2b7edSAmir Vadai { 308917091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 30903bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 3091a88780a9SRoi Dayan int err; 3092776b12b6SOr Gerlitz 309365ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 30941b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 309517091853SOr Gerlitz if (!parse_attr || !flow) { 3096e3a2b7edSAmir Vadai err = -ENOMEM; 3097e3a2b7edSAmir Vadai goto err_free; 3098e3a2b7edSAmir Vadai } 3099e3a2b7edSAmir Vadai 3100e3a2b7edSAmir Vadai flow->cookie = f->cookie; 310165ba8fb7SOr Gerlitz flow->flags = flow_flags; 3102655dc3d2SOr Gerlitz flow->priv = priv; 3103e3a2b7edSAmir Vadai 3104a88780a9SRoi Dayan *__flow = flow; 3105a88780a9SRoi Dayan *__parse_attr = parse_attr; 3106a88780a9SRoi Dayan 3107a88780a9SRoi Dayan return 0; 3108a88780a9SRoi Dayan 3109a88780a9SRoi Dayan err_free: 3110a88780a9SRoi Dayan kfree(flow); 3111a88780a9SRoi Dayan kvfree(parse_attr); 3112a88780a9SRoi Dayan return err; 3113adb4c123SOr Gerlitz } 3114adb4c123SOr Gerlitz 3115988ab9c7STonghao Zhang static void 3116988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr, 3117988ab9c7STonghao Zhang struct mlx5e_priv *priv, 3118988ab9c7STonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr, 3119988ab9c7STonghao Zhang struct tc_cls_flower_offload *f, 3120988ab9c7STonghao Zhang struct mlx5_eswitch_rep *in_rep, 3121988ab9c7STonghao Zhang struct mlx5_core_dev *in_mdev) 3122988ab9c7STonghao Zhang { 3123988ab9c7STonghao Zhang struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3124988ab9c7STonghao Zhang 3125988ab9c7STonghao Zhang esw_attr->parse_attr = parse_attr; 3126988ab9c7STonghao Zhang esw_attr->chain = f->common.chain_index; 3127988ab9c7STonghao Zhang esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16; 3128988ab9c7STonghao Zhang 3129988ab9c7STonghao Zhang esw_attr->in_rep = in_rep; 3130988ab9c7STonghao Zhang esw_attr->in_mdev = in_mdev; 3131988ab9c7STonghao Zhang 3132988ab9c7STonghao Zhang if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) == 3133988ab9c7STonghao Zhang MLX5_COUNTER_SOURCE_ESWITCH) 3134988ab9c7STonghao Zhang esw_attr->counter_dev = in_mdev; 3135988ab9c7STonghao Zhang else 3136988ab9c7STonghao Zhang esw_attr->counter_dev = priv->mdev; 3137988ab9c7STonghao Zhang } 3138988ab9c7STonghao Zhang 313971129676SJason Gunthorpe static struct mlx5e_tc_flow * 314004de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3141a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 31425dbe906fSPaul Blakey u16 flow_flags, 3143d11afc26SOz Shlomo struct net_device *filter_dev, 314404de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep, 314571129676SJason Gunthorpe struct mlx5_core_dev *in_mdev) 3146a88780a9SRoi Dayan { 314773867881SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 3148a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3149a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3150a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3151a88780a9SRoi Dayan int attr_size, err; 3152a88780a9SRoi Dayan 3153a88780a9SRoi Dayan flow_flags |= MLX5E_TC_FLOW_ESWITCH; 3154a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_esw_flow_attr); 3155a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3156a88780a9SRoi Dayan &parse_attr, &flow); 3157a88780a9SRoi Dayan if (err) 3158a88780a9SRoi Dayan goto out; 3159988ab9c7STonghao Zhang 3160d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 3161988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(flow->esw_attr, 3162988ab9c7STonghao Zhang priv, parse_attr, 3163988ab9c7STonghao Zhang f, in_rep, in_mdev); 3164988ab9c7STonghao Zhang 316554c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 316654c177caSOz Shlomo f, filter_dev); 3167d11afc26SOz Shlomo if (err) 3168d11afc26SOz Shlomo goto err_free; 3169a88780a9SRoi Dayan 31706f9af8ffSTonghao Zhang err = parse_tc_fdb_actions(priv, &rule->action, flow, extack); 3171a88780a9SRoi Dayan if (err) 3172a88780a9SRoi Dayan goto err_free; 3173a88780a9SRoi Dayan 31747040632dSTonghao Zhang err = mlx5e_tc_add_fdb_flow(priv, flow, extack); 3175ef06c9eeSRoi Dayan if (err) { 3176ef06c9eeSRoi Dayan if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev))) 3177aa0cbbaeSOr Gerlitz goto err_free; 31785c40348cSOr Gerlitz 3179b4a23329SRoi Dayan add_unready_flow(flow); 3180ef06c9eeSRoi Dayan } 3181ef06c9eeSRoi Dayan 318271129676SJason Gunthorpe return flow; 3183e3a2b7edSAmir Vadai 3184e3a2b7edSAmir Vadai err_free: 3185232c0013SHadar Hen Zion kfree(flow); 3186a88780a9SRoi Dayan kvfree(parse_attr); 3187a88780a9SRoi Dayan out: 318871129676SJason Gunthorpe return ERR_PTR(err); 3189a88780a9SRoi Dayan } 3190a88780a9SRoi Dayan 319104de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f, 319295dc1902SRoi Dayan struct mlx5e_tc_flow *flow, 319395dc1902SRoi Dayan u16 flow_flags) 319404de7ddaSRoi Dayan { 319504de7ddaSRoi Dayan struct mlx5e_priv *priv = flow->priv, *peer_priv; 319604de7ddaSRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw; 319704de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 319804de7ddaSRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 319904de7ddaSRoi Dayan struct mlx5e_rep_priv *peer_urpriv; 320004de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 320104de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev; 320204de7ddaSRoi Dayan int err = 0; 320304de7ddaSRoi Dayan 320404de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 320504de7ddaSRoi Dayan if (!peer_esw) 320604de7ddaSRoi Dayan return -ENODEV; 320704de7ddaSRoi Dayan 320804de7ddaSRoi Dayan peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH); 320904de7ddaSRoi Dayan peer_priv = netdev_priv(peer_urpriv->netdev); 321004de7ddaSRoi Dayan 321104de7ddaSRoi Dayan /* in_mdev is assigned of which the packet originated from. 321204de7ddaSRoi Dayan * So packets redirected to uplink use the same mdev of the 321304de7ddaSRoi Dayan * original flow and packets redirected from uplink use the 321404de7ddaSRoi Dayan * peer mdev. 321504de7ddaSRoi Dayan */ 3216b05af6aaSBodong Wang if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK) 321704de7ddaSRoi Dayan in_mdev = peer_priv->mdev; 321804de7ddaSRoi Dayan else 321904de7ddaSRoi Dayan in_mdev = priv->mdev; 322004de7ddaSRoi Dayan 322104de7ddaSRoi Dayan parse_attr = flow->esw_attr->parse_attr; 322295dc1902SRoi Dayan peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags, 322304de7ddaSRoi Dayan parse_attr->filter_dev, 322471129676SJason Gunthorpe flow->esw_attr->in_rep, in_mdev); 322571129676SJason Gunthorpe if (IS_ERR(peer_flow)) { 322671129676SJason Gunthorpe err = PTR_ERR(peer_flow); 322704de7ddaSRoi Dayan goto out; 322871129676SJason Gunthorpe } 322904de7ddaSRoi Dayan 323004de7ddaSRoi Dayan flow->peer_flow = peer_flow; 323104de7ddaSRoi Dayan flow->flags |= MLX5E_TC_FLOW_DUP; 323204de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 323304de7ddaSRoi Dayan list_add_tail(&flow->peer, &esw->offloads.peer_flows); 323404de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 323504de7ddaSRoi Dayan 323604de7ddaSRoi Dayan out: 323704de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 323804de7ddaSRoi Dayan return err; 323904de7ddaSRoi Dayan } 324004de7ddaSRoi Dayan 324104de7ddaSRoi Dayan static int 324204de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 324304de7ddaSRoi Dayan struct tc_cls_flower_offload *f, 324404de7ddaSRoi Dayan u16 flow_flags, 324504de7ddaSRoi Dayan struct net_device *filter_dev, 324604de7ddaSRoi Dayan struct mlx5e_tc_flow **__flow) 324704de7ddaSRoi Dayan { 324804de7ddaSRoi Dayan struct mlx5e_rep_priv *rpriv = priv->ppriv; 324904de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep = rpriv->rep; 325004de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev = priv->mdev; 325104de7ddaSRoi Dayan struct mlx5e_tc_flow *flow; 325204de7ddaSRoi Dayan int err; 325304de7ddaSRoi Dayan 325471129676SJason Gunthorpe flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep, 325571129676SJason Gunthorpe in_mdev); 325671129676SJason Gunthorpe if (IS_ERR(flow)) 325771129676SJason Gunthorpe return PTR_ERR(flow); 325804de7ddaSRoi Dayan 325904de7ddaSRoi Dayan if (is_peer_flow_needed(flow)) { 326095dc1902SRoi Dayan err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags); 326104de7ddaSRoi Dayan if (err) { 326204de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(priv, flow); 326304de7ddaSRoi Dayan goto out; 326404de7ddaSRoi Dayan } 326504de7ddaSRoi Dayan } 326604de7ddaSRoi Dayan 326704de7ddaSRoi Dayan *__flow = flow; 326804de7ddaSRoi Dayan 326904de7ddaSRoi Dayan return 0; 327004de7ddaSRoi Dayan 327104de7ddaSRoi Dayan out: 327204de7ddaSRoi Dayan return err; 327304de7ddaSRoi Dayan } 327404de7ddaSRoi Dayan 3275a88780a9SRoi Dayan static int 3276a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv, 3277a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 32785dbe906fSPaul Blakey u16 flow_flags, 3279d11afc26SOz Shlomo struct net_device *filter_dev, 3280a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3281a88780a9SRoi Dayan { 328273867881SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 3283a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3284a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3285a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3286a88780a9SRoi Dayan int attr_size, err; 3287a88780a9SRoi Dayan 3288bf07aa73SPaul Blakey /* multi-chain not supported for NIC rules */ 3289bf07aa73SPaul Blakey if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common)) 3290bf07aa73SPaul Blakey return -EOPNOTSUPP; 3291bf07aa73SPaul Blakey 3292a88780a9SRoi Dayan flow_flags |= MLX5E_TC_FLOW_NIC; 3293a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_nic_flow_attr); 3294a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3295a88780a9SRoi Dayan &parse_attr, &flow); 3296a88780a9SRoi Dayan if (err) 3297a88780a9SRoi Dayan goto out; 3298a88780a9SRoi Dayan 3299d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 330054c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 330154c177caSOz Shlomo f, filter_dev); 3302d11afc26SOz Shlomo if (err) 3303d11afc26SOz Shlomo goto err_free; 3304d11afc26SOz Shlomo 330573867881SPablo Neira Ayuso err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack); 3306a88780a9SRoi Dayan if (err) 3307a88780a9SRoi Dayan goto err_free; 3308a88780a9SRoi Dayan 3309a88780a9SRoi Dayan err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack); 3310a88780a9SRoi Dayan if (err) 3311a88780a9SRoi Dayan goto err_free; 3312a88780a9SRoi Dayan 3313a88780a9SRoi Dayan flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 3314a88780a9SRoi Dayan kvfree(parse_attr); 3315a88780a9SRoi Dayan *__flow = flow; 3316a88780a9SRoi Dayan 3317a88780a9SRoi Dayan return 0; 3318a88780a9SRoi Dayan 3319a88780a9SRoi Dayan err_free: 3320a88780a9SRoi Dayan kfree(flow); 3321a88780a9SRoi Dayan kvfree(parse_attr); 3322a88780a9SRoi Dayan out: 3323a88780a9SRoi Dayan return err; 3324a88780a9SRoi Dayan } 3325a88780a9SRoi Dayan 3326a88780a9SRoi Dayan static int 3327a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv, 3328a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 3329a88780a9SRoi Dayan int flags, 3330d11afc26SOz Shlomo struct net_device *filter_dev, 3331a88780a9SRoi Dayan struct mlx5e_tc_flow **flow) 3332a88780a9SRoi Dayan { 3333a88780a9SRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 33345dbe906fSPaul Blakey u16 flow_flags; 3335a88780a9SRoi Dayan int err; 3336a88780a9SRoi Dayan 3337a88780a9SRoi Dayan get_flags(flags, &flow_flags); 3338a88780a9SRoi Dayan 3339bf07aa73SPaul Blakey if (!tc_can_offload_extack(priv->netdev, f->common.extack)) 3340bf07aa73SPaul Blakey return -EOPNOTSUPP; 3341bf07aa73SPaul Blakey 3342a88780a9SRoi Dayan if (esw && esw->mode == SRIOV_OFFLOADS) 3343d11afc26SOz Shlomo err = mlx5e_add_fdb_flow(priv, f, flow_flags, 3344d11afc26SOz Shlomo filter_dev, flow); 3345a88780a9SRoi Dayan else 3346d11afc26SOz Shlomo err = mlx5e_add_nic_flow(priv, f, flow_flags, 3347d11afc26SOz Shlomo filter_dev, flow); 3348a88780a9SRoi Dayan 3349a88780a9SRoi Dayan return err; 3350a88780a9SRoi Dayan } 3351a88780a9SRoi Dayan 335271d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv, 3353a88780a9SRoi Dayan struct tc_cls_flower_offload *f, int flags) 3354a88780a9SRoi Dayan { 3355a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3356d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3357a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3358a88780a9SRoi Dayan int err = 0; 3359a88780a9SRoi Dayan 3360a88780a9SRoi Dayan flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 3361a88780a9SRoi Dayan if (flow) { 3362a88780a9SRoi Dayan NL_SET_ERR_MSG_MOD(extack, 3363a88780a9SRoi Dayan "flow cookie already exists, ignoring"); 3364a88780a9SRoi Dayan netdev_warn_once(priv->netdev, 3365a88780a9SRoi Dayan "flow cookie %lx already exists, ignoring\n", 3366a88780a9SRoi Dayan f->cookie); 33670e1c1a2fSVlad Buslov err = -EEXIST; 3368a88780a9SRoi Dayan goto out; 3369a88780a9SRoi Dayan } 3370a88780a9SRoi Dayan 3371d11afc26SOz Shlomo err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow); 3372a88780a9SRoi Dayan if (err) 3373a88780a9SRoi Dayan goto out; 3374a88780a9SRoi Dayan 3375a88780a9SRoi Dayan err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params); 3376a88780a9SRoi Dayan if (err) 3377a88780a9SRoi Dayan goto err_free; 3378a88780a9SRoi Dayan 3379a88780a9SRoi Dayan return 0; 3380a88780a9SRoi Dayan 3381a88780a9SRoi Dayan err_free: 3382a88780a9SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3383a88780a9SRoi Dayan kfree(flow); 3384a88780a9SRoi Dayan out: 3385e3a2b7edSAmir Vadai return err; 3386e3a2b7edSAmir Vadai } 3387e3a2b7edSAmir Vadai 33888f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS) 33898f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS) 33908f8ae895SOr Gerlitz 33918f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 33928f8ae895SOr Gerlitz { 33938f8ae895SOr Gerlitz if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK)) 33948f8ae895SOr Gerlitz return true; 33958f8ae895SOr Gerlitz 33968f8ae895SOr Gerlitz return false; 33978f8ae895SOr Gerlitz } 33988f8ae895SOr Gerlitz 339971d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv, 340060bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3401e3a2b7edSAmir Vadai { 3402d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3403e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 3404e3a2b7edSAmir Vadai 340505866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 34068f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3407e3a2b7edSAmir Vadai return -EINVAL; 3408e3a2b7edSAmir Vadai 340905866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 3410e3a2b7edSAmir Vadai 3411961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3412e3a2b7edSAmir Vadai 3413e3a2b7edSAmir Vadai kfree(flow); 3414e3a2b7edSAmir Vadai 3415e3a2b7edSAmir Vadai return 0; 3416e3a2b7edSAmir Vadai } 3417e3a2b7edSAmir Vadai 341871d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv, 341960bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3420aad7e08dSAmir Vadai { 342104de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 3422d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 342304de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 3424aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 3425aad7e08dSAmir Vadai struct mlx5_fc *counter; 3426316d5f72SRoi Dayan u64 lastuse = 0; 3427316d5f72SRoi Dayan u64 packets = 0; 3428316d5f72SRoi Dayan u64 bytes = 0; 3429aad7e08dSAmir Vadai 343005866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 34318f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3432aad7e08dSAmir Vadai return -EINVAL; 3433aad7e08dSAmir Vadai 3434316d5f72SRoi Dayan if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 3435b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 3436aad7e08dSAmir Vadai if (!counter) 3437aad7e08dSAmir Vadai return 0; 3438aad7e08dSAmir Vadai 3439aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 3440316d5f72SRoi Dayan } 3441aad7e08dSAmir Vadai 3442316d5f72SRoi Dayan /* Under multipath it's possible for one rule to be currently 3443316d5f72SRoi Dayan * un-offloaded while the other rule is offloaded. 3444316d5f72SRoi Dayan */ 344504de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 344604de7ddaSRoi Dayan if (!peer_esw) 344704de7ddaSRoi Dayan goto out; 344804de7ddaSRoi Dayan 344904de7ddaSRoi Dayan if ((flow->flags & MLX5E_TC_FLOW_DUP) && 345004de7ddaSRoi Dayan (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) { 345104de7ddaSRoi Dayan u64 bytes2; 345204de7ddaSRoi Dayan u64 packets2; 345304de7ddaSRoi Dayan u64 lastuse2; 345404de7ddaSRoi Dayan 345504de7ddaSRoi Dayan counter = mlx5e_tc_get_counter(flow->peer_flow); 3456316d5f72SRoi Dayan if (!counter) 3457316d5f72SRoi Dayan goto no_peer_counter; 345804de7ddaSRoi Dayan mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2); 345904de7ddaSRoi Dayan 346004de7ddaSRoi Dayan bytes += bytes2; 346104de7ddaSRoi Dayan packets += packets2; 346204de7ddaSRoi Dayan lastuse = max_t(u64, lastuse, lastuse2); 346304de7ddaSRoi Dayan } 346404de7ddaSRoi Dayan 3465316d5f72SRoi Dayan no_peer_counter: 346604de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 346704de7ddaSRoi Dayan out: 34683b1903efSPablo Neira Ayuso flow_stats_update(&f->stats, bytes, packets, lastuse); 3469fed06ee8SOr Gerlitz 3470aad7e08dSAmir Vadai return 0; 3471aad7e08dSAmir Vadai } 3472aad7e08dSAmir Vadai 34734d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv, 34744d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv) 34754d8fcf21SAlaa Hleihel { 34764d8fcf21SAlaa Hleihel struct mlx5_core_dev *peer_mdev = peer_priv->mdev; 34774d8fcf21SAlaa Hleihel struct mlx5e_hairpin_entry *hpe; 34784d8fcf21SAlaa Hleihel u16 peer_vhca_id; 34794d8fcf21SAlaa Hleihel int bkt; 34804d8fcf21SAlaa Hleihel 34814d8fcf21SAlaa Hleihel if (!same_hw_devs(priv, peer_priv)) 34824d8fcf21SAlaa Hleihel return; 34834d8fcf21SAlaa Hleihel 34844d8fcf21SAlaa Hleihel peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 34854d8fcf21SAlaa Hleihel 34864d8fcf21SAlaa Hleihel hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) { 34874d8fcf21SAlaa Hleihel if (hpe->peer_vhca_id == peer_vhca_id) 34884d8fcf21SAlaa Hleihel hpe->hp->pair->peer_gone = true; 34894d8fcf21SAlaa Hleihel } 34904d8fcf21SAlaa Hleihel } 34914d8fcf21SAlaa Hleihel 34924d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this, 34934d8fcf21SAlaa Hleihel unsigned long event, void *ptr) 34944d8fcf21SAlaa Hleihel { 34954d8fcf21SAlaa Hleihel struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 34964d8fcf21SAlaa Hleihel struct mlx5e_flow_steering *fs; 34974d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv; 34984d8fcf21SAlaa Hleihel struct mlx5e_tc_table *tc; 34994d8fcf21SAlaa Hleihel struct mlx5e_priv *priv; 35004d8fcf21SAlaa Hleihel 35014d8fcf21SAlaa Hleihel if (ndev->netdev_ops != &mlx5e_netdev_ops || 35024d8fcf21SAlaa Hleihel event != NETDEV_UNREGISTER || 35034d8fcf21SAlaa Hleihel ndev->reg_state == NETREG_REGISTERED) 35044d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35054d8fcf21SAlaa Hleihel 35064d8fcf21SAlaa Hleihel tc = container_of(this, struct mlx5e_tc_table, netdevice_nb); 35074d8fcf21SAlaa Hleihel fs = container_of(tc, struct mlx5e_flow_steering, tc); 35084d8fcf21SAlaa Hleihel priv = container_of(fs, struct mlx5e_priv, fs); 35094d8fcf21SAlaa Hleihel peer_priv = netdev_priv(ndev); 35104d8fcf21SAlaa Hleihel if (priv == peer_priv || 35114d8fcf21SAlaa Hleihel !(priv->netdev->features & NETIF_F_HW_TC)) 35124d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35134d8fcf21SAlaa Hleihel 35144d8fcf21SAlaa Hleihel mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv); 35154d8fcf21SAlaa Hleihel 35164d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35174d8fcf21SAlaa Hleihel } 35184d8fcf21SAlaa Hleihel 3519655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 3520e8f887acSAmir Vadai { 3521acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 35224d8fcf21SAlaa Hleihel int err; 3523e8f887acSAmir Vadai 352411c9c548SOr Gerlitz hash_init(tc->mod_hdr_tbl); 35255c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 352611c9c548SOr Gerlitz 35274d8fcf21SAlaa Hleihel err = rhashtable_init(&tc->ht, &tc_ht_params); 35284d8fcf21SAlaa Hleihel if (err) 35294d8fcf21SAlaa Hleihel return err; 35304d8fcf21SAlaa Hleihel 35314d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event; 35324d8fcf21SAlaa Hleihel if (register_netdevice_notifier(&tc->netdevice_nb)) { 35334d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = NULL; 35344d8fcf21SAlaa Hleihel mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n"); 35354d8fcf21SAlaa Hleihel } 35364d8fcf21SAlaa Hleihel 35374d8fcf21SAlaa Hleihel return err; 3538e8f887acSAmir Vadai } 3539e8f887acSAmir Vadai 3540e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 3541e8f887acSAmir Vadai { 3542e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 3543655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 3544e8f887acSAmir Vadai 3545961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3546e8f887acSAmir Vadai kfree(flow); 3547e8f887acSAmir Vadai } 3548e8f887acSAmir Vadai 3549655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 3550e8f887acSAmir Vadai { 3551acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 3552e8f887acSAmir Vadai 35534d8fcf21SAlaa Hleihel if (tc->netdevice_nb.notifier_call) 35544d8fcf21SAlaa Hleihel unregister_netdevice_notifier(&tc->netdevice_nb); 35554d8fcf21SAlaa Hleihel 3556d9ee0491SOr Gerlitz rhashtable_destroy(&tc->ht); 3557e8f887acSAmir Vadai 3558acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 3559acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 3560acff797cSMaor Gottlieb tc->t = NULL; 3561e8f887acSAmir Vadai } 3562e8f887acSAmir Vadai } 3563655dc3d2SOr Gerlitz 3564655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 3565655dc3d2SOr Gerlitz { 3566655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 3567655dc3d2SOr Gerlitz } 3568655dc3d2SOr Gerlitz 3569655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 3570655dc3d2SOr Gerlitz { 3571655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 3572655dc3d2SOr Gerlitz } 357301252a27SOr Gerlitz 3574d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags) 357501252a27SOr Gerlitz { 3576d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 357701252a27SOr Gerlitz 357801252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 357901252a27SOr Gerlitz } 358004de7ddaSRoi Dayan 358104de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw) 358204de7ddaSRoi Dayan { 358304de7ddaSRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 358404de7ddaSRoi Dayan 358504de7ddaSRoi Dayan list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer) 358604de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 358704de7ddaSRoi Dayan } 3588b4a23329SRoi Dayan 3589b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work) 3590b4a23329SRoi Dayan { 3591b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *rpriv = 3592b4a23329SRoi Dayan container_of(work, struct mlx5_rep_uplink_priv, 3593b4a23329SRoi Dayan reoffload_flows_work); 3594b4a23329SRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 3595b4a23329SRoi Dayan 3596b4a23329SRoi Dayan rtnl_lock(); 3597b4a23329SRoi Dayan list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) { 3598b4a23329SRoi Dayan if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL)) 3599b4a23329SRoi Dayan remove_unready_flow(flow); 3600b4a23329SRoi Dayan } 3601b4a23329SRoi Dayan rtnl_unlock(); 3602b4a23329SRoi Dayan } 3603